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ABSTRACT 



A position measuring system for a remotely controlled video camera was designed 
and built. The camera is intended to be used with the modified Advance Development 
Model of the AN/SAR-8 Infrared Search and Target Designation System (IRSTD) in 
use at the Naval Postgraduate School. The video data collected by the camera will be 
correlated with the infrared data from the IRSTD to develop a background data base 
that will be used in the developement of signal processing algorithms. 

The measurement system uses two Hewlett Packard HEDS-6000 incremental optical 
encoders, two Motorola MC68705U3 microprocessors and two digital display devices to 
measure and present the camera's azimuth and elevation angles to an operator at a re- 
mote location. The azimuth can be measured over a range of 360° with a resolution of 
+ 0.0213° and the elevation can be measured over 24° with a resolution of + 0.138°. 
The resolution is limited primarily by hysteresis, which is due to the backlash in the gears 
between the transducers and the axes of interest. 



THESIS DISCLAIMER 



The reader is cautioned that computer programs developed in this research may not 
have been exercised for all cases of interest. While every effort has been made, within 
the time available, to ensure that the programs are free of computational and logic er- 
rors, they cannot be considered validated. Any application of these programs without 
additional verification is at the risk of the user. 
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I. INTRODUCTION 



A. BACKGROUND 

The old saying that “every solution breeds new problems”, while somewhat pessi- 
mistic, quite often rings true in today's increasingly technical world. One such example 
is the use of infrared (IR) sensors for the detection, tracking and/or identification of 
targets in a combat environment. IR sensors are ideally suited for use on today's bat- 
tlefield. They are passive, i.e., they do not need to emit energy in order to detect the 
presence of potential targets. This allows them to operate during times of emission 
control when many other target detection systems are useless. They have the ability to 
“see through” many forms of camouflage and concealment, dust, clouds, smoke, etc., 
that might otherwise afford an enemy target a safe haven. Additionally, because almost 
everything on today's battlefield generates some degree of infrared energy, IR sensors 
can be used to locate and identify a wide variety of targets. 

The extent to which a particular IR sensor is useful depends primarily on its ability 
to detect and identify targets reliably and accurately. Detection of the target is primarily 
a function of the IR sensor's sensitivity. The classification of a received IR signal as a 
potential target or as background noise, while still dependant on the sensitivity of the 
sensors, is primarily a function of the quality of the signal processing algorithms being 
used to process the received signals. In addition to being reliable these algorithms must 
be able to process the received signals in “real time” if the system is to be an effective 
weapons system. 

Creation of a background data base that can be used to test some of these algo- 
rithms has been one of the tasks being perfomted by the Naval Academic Center for 
Infrared Technology (NACIT) located at the Naval Postgraduate School (NPS). The 
Advanced Development Model (ADM) of the AN/SAR-8 was sent to the NACIT in 
January of 1984 from the Naval Surface Weapons Center (N'SWC) at Dahlgren, 
Virginia. The ADM was modified, calibrated and placed in service at NPS in December, 
1987. The modified version of the AD VI, the Infrared Search and Target Designation 
(IRSTD) System, is currently operational at NTS. [Ref 1: pp. 8-12] 

One way to enhance the usefulness of the IR data being collected at NPS would be 
to collect video data concurrently with the IR data. A video image of a portion of the 
horizon would permit visual identification of IR sources in that region. This additional 
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lional information could be an aid in the development of the signal processing algo- 
rithms for the IRSTD. Accordingly, a decision to proceed with video data collection 
was made by NACIT, and a camera system was purchased. Components of the system 
include; 

• RCA (TC1005 01), Closed circuit video camera, 

• PELCO (AI700), Automatic iris servo. 

• PELCO (F1.5X), 1.5 times range extender. 

• PELCO (MLZ6DT), Desk top lens remote control module. 

• PELCO (PTI250DC), Heavy duty Pan/Tilt servo. 

• PELCO (MPTV1510DT), Pan/Tilt remote control unit. 

• Panasonic (WV-5410), Video Monitor. 

In Ref I Ayers describes the IRSTD's detectors: 

The IR detectors consist of two vertical arrays of sensing elements in the focal plane 
of the Schmidt telescope. The telescope is rotated so as to sweep the image across 
the detector arrays. Each array incorporates a column of 90 indium antimonide 
photovoltic linear detector elements. These two arrays are independent of each 
other and are covered by filters which pass selected wavebands of IR radiation in the 
3 to 5 micrometer range. Each element has the angular dimensions of 2 X .3 
milliradians with the larger being its height. Designated as the lead and the lag, 
these two arrays are separated by about one-half degree in azimuth. [Ref 1: p. 17] 

Thus, as the IRSTD scans the horizon the resulting IR image has a resolution of ap- 
proximately lO"'* radians (0.00573°) in the horizontal plane and 0.23° in the vertical 
plane. The video system's smaller field of view can be remotely controlled using the 
control units listed above. Thus, for the video data to be of any use in the development 
of the signal processing algorithms, the camera's orientation must first be known, and, 
in order to determine the pixel-to-pixel correlation between the IR image and the video 
image, the position of the video camera needs to be known with the same kind of accu- 
racy as the IR image. The design and implementation of a position measuring system 
for this remotely controlled video camera is the subject of this thesis. 

B. DESIGN SPECIFICATIONS 

The design specifications for this problem were relatively straight forward. The po- 
sition measuring system needed to meet the following criteria. 

• The system should be able to measure the elevation angle (tilt), above and below 
the horizontal reference plane of the camera over a range of ± 12°. 

• The measured elevation angle should be accurate to within ± 0.23° . 
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• The system should be able to measure the bearing (pan), left or right of some ar- 
bitrar}' reference, of the camera over a range of 360°. 

• The measured bearing should be accurate to within ± 10''* radians. 

• The output should be displayed in a convenient form. The display should be 
collocated with the camera servo remote controls, an indoor site approximately 200 
meters away from the camera. 

• Portions of the measuring system required to be collocated with the camera should 
be weatherproofed. 

• The system must be reliable and should be simple to operate. 
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II. DESIGN STRATEGY 



A. GENERAL 

A position measuring system, like any system, is a combination of devices intercon- 
nected to perform a certain function. The most basic position measuring system (see 
Figure 1) consists of only four such devices: a transducer, a signal conditioner, a display 
device and a power supply. More complicated position measuring systems include those 
designed to take a number of different measurements either simultaneously or consec- 
utively. Still more complex systems multiplex these various measurements over a single 
channel to some distant location where they can be processed and displayed. [Ref 2: 
pp. 2-14] 

The design specifications for the camera position measurement system (subsequently 
referred to as the “measurement system") required that two measurements, pan and tilt, 
be taken simultaneously and transmitted some distance to a remote display. Two sepa- 
rate transducers, capable of independent operation, were therefore required. In order for 
both the azimuth and the elevation to be displayed simultaneously two display devices 
were also required. 

Several pairs of RG-178 coaxial cable were available to transmit signals between the 
camera servo and the remote control site. Since the cable was available and it was de- 
sirable to reduce the system complexity, a decision was made not to multiplex the data 
over a single channel. Instead, each measurand would have a separate transducer, a 
dedicated signal processor and a unique display device. Position information for each 
axis would be transmitted over a dedicated channel. 

The physical locations of the transducers and the display devices were dictated by 
the design specifications; however, there was some flexibility in deciding where to locate 
the signal conditioner. Site selection was based on an attempt to maximize total system 
performance and simplicity while ensuring the maintainability and environmental integ- 
rity of the signal conditioner. The only advantage to locating the signal conditioner with 
the camera servo and the transducer would have been to limit the distance that the 
transducer's output signal would have to be transmitted to the processor. On the other 
hand, separating the signal conditioner and the transducers would limit the distance over 
which the conditioned signal would have to be transmitted to the display device. The 
trade-olT here was not clear cut and would probably depend on the specific hardware 
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Figure I. Basic Electronic Position Measuring System; I'roni Ref. 2: p. 2 



used and the speed of rotation of the camera servo. There was one significant advan- 
tage, however, to collocating the display and the signal processor; since they would both 
be indoors, the need for weatherproofing the signal processor would be eliminated. 

Power was available at both ends of the system, there was therefore no requirement 
to have a conunon power supply for the entire system. One supply could be used to 
provide power to the two transducers, collocated with the camera servo, and a second 
supply could power the signal conditioner and the displays. 

A block diagram of the prototype measurement system is shown interconnected with 
the camera positioning system in Figure 2. Once this basic system layout had been de- 
termined, proper selection of the actual hardware was necessary. The design criteria 
were the primary consideration in the initial stages of the hardware selection. Final se- 
lection of the specific components, however, involved balancing additional factors, such 
as availability and cost against the system requirements. 
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Figure 2. Camera Position Measuring S) steni 
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B. TRANSDUCERS 
1. General 

Since in practice most measurement systems do not have the ability to respond 
directly to the measurand, transducers are used to convert one physical quantity (e.g., 
angular position) into another, more usable quantity or signal (e.g., an electrical signal) 
[Ref. 3: p. 1-4]. The transducer is therefore a vital part of any measurement system, and 
although none of the components of this system could have been chosen independently 
of the other elements, proper transducer selection appeared to be the key to meeting the 
design specifications. Thus, selection of a transducer was the next step in the design 
process. 

Using the selection guidelines given by Norton on pages 51-53 of Ref 2 and the 
design criteria stated previously, several observations and decisions were made which 
significantly reduced the number of transducers considered feasible for use in the meas- 
urement system. The fact that the servo was capable of rotating the camera left or right, 
and up or down suggested that the transducer should be capable of detecting both in- 
creasing and decreasing angles on both axes. Additionally, since the servo was antic- 
ipated to rotate the camera through one 360° arc in the horizontal plane, the transducer 
used to measure this angle (subsequently referred to as the “pan transducer”) needed to 
have a comparable range capability. The range requirement for the “tilt transducer” 
(used to measure the elevation angle) was much less restrictive. These factors, angular 
bidirectional capability and full scale range, eliminated a great number of transducers 
from the list of candidates. 

The list was further narrowed by the accuracy requirements previously specified. 
Again the accuracy in the horizontal plane placed a much more severe limitation on the 
selection of a transducer than the accuracy requirements for the vertical plane. The 
following paragraphs in this section outline the logic used in the selection of the 
transducers. The factors considered in the selection process included the following; 

• The accuracy requirements given in the specifications. 

• The ease with which a specific transducer could be installed on the servo. 

• The ability to weatherproof the servo and the transducer once the transducer was 
installed. 

• The rotation speed of the camera about the servo axes. 

• The extent to which a particular transducer/mounting configuration would modify 
the measurand. 

• Cost effectiveness. 
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• Availability. 

• Signal conditioning requirements. 

• The e.xtent to which the selection of a particular transducer would simplify or 
complicate the modification or expansion of the measurement system. 

2. Transducer technologies 

Displacement transducer technologies fall into three very broad categories de- 
pending on whether they are capable of measuring linear or angular displacement, or 
both. Some technologies could be eliminated immediately since they were clearly not 
suited for measuring angular position. Strain gauge displacement transducers, inductive 
displacement transducers and vibrating-wire displacement transducers are examples of 
such devices. The following paragraphs briefly describe the different transducer tech- 
nologies which were investigated. Table 1 on page 18 sununarizes the salient points of 
the discussion. [Ref 2: pp. 90-117]. 

a. Reluctire Displacement Transducers 

The rotary' variable differential transformer (RVDT), which operates by 
detecting a change in the reluctance between coils, offers excellent resolution, dynamic 
characteristics, linearity and life expectancy [Ref 3: p. (2-14)]. Figure 3 shows a sche- 
matic diagram and a simplified cross-section of an RVDT. The ferromagnetic, 
cardioid-shaped core is attached to a shaft as shown. As the shaft rotates, the inductive 
coupling between the primary and each of the secondary coils changes. When the cam 
is synuuetric with respect to the two secondary coils, their output voltages are equal but 
opposite in phase which results in a differential output voltage of zero. As the shaft 
rotates away from this “null” the dilTerential output voltage varies as shown in 
Figure 4. The linear region of the curve is limited to the angles between ± 40° of the 
reference. Thus, the RVDT could not be used on the Pan axis. It was however, initially 
considered as a candidate for the Tilt transducer, [Refs. 2: pp. 93-99, 3: 
pp. (9-10)-(9-13) and 4: p. 19] 

Another type of reluctive displacement transducer is manufactured by 
Farrand Controls. Their INDUCTOSYX rotary position transducers have accuracies 
to ± 1.5 arc sec (:i:(4 x 10"'’)°). Unfortunately, these devices are 1 1.89 inches in diameter, 
and mounting them on the camera servo would have been extremely difficult, if not im- 
possible. [Refs. 2: pp. 89-1 11,5] 
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Figure 3. RVDT Schematic: From Ref. 2; p. 98. 



b. Capacitive Displacement Transducers 

Angular displacement can also be measured by coupling the rotating com- 
ponent to the shaft a of variable capacitor in the manner shown in Figure 5. Lenk de- 
scribes the operation of the capacitive displacement transducer quite succinctly. 

The capacitor ... consists of a metal plate that moves between two fixed metal plates 
as a shaft is rotated. The three plates, and the air between them, form a capacitor 
with a capacitance that varies in proportion to the degree to which the plates are 
meshed. When the plates are completely meshed, the capacitance is at its maximum. 
When the plates are completelv unmeshed, the capacitance is at minimum. [Ref 4: 

p. 18] 



Capacitive displacement transducers offer many of the advantages of reluc- 
tance displacement tr-'insducers. They have an effective range of about 300° which, while 
better than the RVDT's range, is still not adequate for the pan axis (Ref 4; p. IS). Ad- 
ditionally they are more sensitive to changes in the ambient temperature. Since the 
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Figure 4. RVDT Output Characteristics: From Ref. 2: p. 95. 




Figure 5. Capacitive Displacement Transducer: Ref 4: p. IS. 

measurement system was being designed to be used outdoors, the use of a capacitive 
displacement transducer would have required the addition of a temperature compensator 
in the design. While possible, this would have increased the system complexity consid- 
erably. (Ref 2; pp. 90-91) 
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c. Potentiometnc Displacement Transducers 

Another very common and relatively simple family of transducers operate 
by measuring the change in resistance caused by a change in the measurand. There are 
a wide variety of such devices available. The basic form of potentiometric angular dis- 
placement transducers uses a resistance element, formed into an arc, and a movable 
electrical contact that rotates about the axis of interest. By measuring the change in 
resistance that results from a change in position, one is able to determine the angular 
displacement. The resistive element is typically a w'irewound element, the resolution of 
which is determined by the number of turns per unit length of the resistance element. 
The angular resolution can be increased by increasing the turn density (wires/degree) of 
the potentiometer. 

The practical limit for wire spacing on wirewound elements according to 
Ref 6 is between 500 and 1000 turns per inch. From Figure 6 one can see that this 
limits the angular resolution for a single-turn device to 

{ Ax (in) \ 

A0(rad)=.an(-^j (1) 



Therefore, 



A0(rad)^ 



2Ax 

D 



0.002(in) 

D(in) 



( 2 ) 



To achieve the 10““ rad resolution, specified for the Pan axis, with a single turn 
potentiometer would therefore require a 20 in diameter potentiometer. Mounting a de- 
vice this large on the camera servo was simply not feasible. Potentiometers are, how- 
ever, available with multiple turns. Shaped in a helix fashion similar to that shown in 
Figure 7, the total length of the potentiometer can be increased, which in turn increases 
its resolution, without increasing the diameter of the device. 

Increasing the resolution of the potentiometer by increasing the turn density 
in any of the manners described above, however, increases the output impedance of the 
device, which leads to increasing nonlinearity between the measurand and the transducer 
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Figure 6. Geometry of an Angular Poteiitiometric Transducer 




Figure 7. Multiturn Potentiometer: From Ref. 6: p. 218 

output. The nonlinear relationship can be seen by analyzing the circuit shown in 
Figure 8. In the diagram the following variable definitions apply: 

• Cx = Input voltage, 

• e^ = Output voltage, 

• = Total resistance of the potentiometer, 

• R„ = -Vleter resistance, 

• x,= Total range of the potentiometer, and 

• X, = Actual displacement of the potentiometer. 

Assuming that Rps uniformly distributed over x„ analysis of the voltage divider circuit 
gives. 




( 3 ) 
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Figure 8. Potentiometric Transducer: From Ref. 6; p. 219 

Thus, the ideal (i.e., linear ) relationship, 



is true only when R„ = 0, and since R, 0, and R„ ^ oo, the nonlinear relationship in 
(3) will always exist. Doebelin states that “for values of R,/R„<0. 1 the position of 
maximum error occurs in the neighborhood of xjx, = 0.67, and the maximum error is 
approximately 15(R,/R„) percent of full scale.” (Ref 6; p. 218] Other potentiometric 
transducers, which use a resistive element made of carbon film or a conducting plastic, 
are not subject to the same kind of resolution limitations as wirewound devices; however, 
they do have high output impedances and the corresponding nonlinearities described 
above. [Ref 6: pp. 217-224] 

A high quality multiturn potentiometer used in conjunction with a high 
quality voltmeter offered one possible solution to the design problem. However, the 
nonlinearity of this arrangement was a significant disadvantage, and the primarx’ reason 
why potentiometers were not used. 
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d. Encoders 



The angular displacement transducer, referred to in general as an angular 
encoder or shaft encoder, converts an angular displacement into a digital signal without 
the use of an analog-to-digital converter. In today's increasingly digital world this can 
be a distinct advantage. 

There are three different transduction methods used in encoders. Magnetic 
encoders use a pattern made from magnetized and nonmagnetized segments and one or 
more magnetic sensors that register as either “I's” or “O's” depending on the magnetic 
characteristics of the section that they are adjacent to. Brush-type encoders are similar, 
but the sections are made of conducting and nonconducting materials. The conductors 
are all tied to a common source and the “sensor” is one or more brushes connected to 
the output. When the brush is in contact with one of the conductors the output is 
“on” and when the brush is in contact with an insulator the output is “off. Optical 
encoders (See Figure 9) use a pattern of opaque sections marked on an otherwise 
transparent disk. A light emitting diode (LED), or other light source, is placed on one 
side of the disk, and as the disk rotates a light sensor on the other side of the disk 
“sees” periods of dark and light which it converts into a digital signal. [Ref 2: p. 106] 

Angular encoders are further categorized as either absolute encoders or in- 
cremental encoders. Absolute encoders, similar to the optical encoder shown in 
Figure 9, use a multitrack pattern on a code wheel to produce a unique coded output 
signal for each incremental change in the measurand. These wheels use a variety of 
codes, including binary code, binary-coded decimal (BCD) and Gray code, to determine 
the shaft position. The resolution of an absolute shaft encoder is liirdted by the number 
of tracks on the disk and the type of code used. A simple binar\' or Gray code encoder, 
which are more efficient than the BCD encoders, with X tracks has an optimum angular 
resolution of 







( 5 ) 



Thus, to achieve the desired resolution of 10'^ radians on the Pan axis with an absolute 
encoder would require a code wheel with X' > 16. Since the output from the encoder is 
unique for each position, these devices are not affected by power outages, and the re- 
quirements for a signal processor for such a device would be limited to a simple decoding 
circuit. These encoders can measure angles of up to 360° without ambiguity. 
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Incremenial encoders use a code wheel which has only one track. As the 
shaft of the incremental encoder rotates the output from the encoder is a series of 
equally spaced pulses. These pulses can then be used as an input signal to an up'down 
(U, D) counter of some sort. The output from the counter is an indication of the dis- 
placement of the axis from some predetermined reference. The resolution of an incre- 
mental encoder is a function of the number of pulses the code wheel generates per 
revolution and is given by; 



Ad = 



360° 

n X PTR 



( 6 ) 



where PPR is the number of pulses per revolution of the code wheel, and n is the number 
of revolutions that the code wheel makes per revolution of the a.xis of interest. If the 
incremental shaft encoder was mounted on the shaft of interest (n= 1) at least 62,832 
PPR would be required to ensure a resolution of 10*^ radians. 




Figure 9. Absolute Photoelectric Angular Encoder: (a) typical code disk; (b) en- 

coder elements. From Ref 2: p. 107. 



Shaft encoders currently range in price from less than Si 00.00 to several 
thousand dollars depending on their capabilities and the method of transduction used. 
Litton Encoder's Model 60 absolute shaft encoder uses a natural binary code, has 15 
tracks (0.1917 nuad resolution) and is available “off the shelf for approximately S3000. 
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Other absolute encoders with comparable resolutions are available at similar prices. No 
incremental encoders were found which offered the same kind of resolution as Litton's 
Model 60; however, because they are not limited to one revolution of the axis, the re- 
solution of an incremental encoder can be improved by a factor of n by causing its code 
wheel to rotate n times for ever}’ rotation of the axis of interest. Incremental encoders 
with 1024 PPR are available from a variety of manufacturers for about SlOO each. 
Connecting such a device to the axis of interest via a gear train with a 50:1 ratio would 
theoretically result (from (6)) in a resolution of 0.1227 mrad. Incremental encoders do 
require more complex signal processing than absolute encoders, and they are affected 
by power shut-off Additionally, unlike absolute encoders, any missed or erroneous 
count that occurs with an incremental encoder will cause a persistent error. [Ref 7: 

p. 16] 

After considering the measurement system performance criteria and the ca- 
pabilities and limitations of the various transducers, the use of an incremental, optical 
shaft encoder appeared to be the best selection for the transducer for each a.xis. This 
decision involved balancing the various advantages and disadvantages of the different 
transducers. The following list gives a summary of the key considerations in this deci- 
sion. 

• Small, lightweight, highly accurate and relatively inexpensive models were readily 
available. Being small and lightweight suggested that mounting and 
weatherproofing the transducers in the camera servo should not be too difficult. 

• Absolute encoders offer almost all of the advantages of the incremental encoders; 
they are not affected by power outage, they require less complex signal processing 
and one time counting errors do not persist. However, these features did not seem 
to justify the additional price of an absolute encoder. 

• Linearity and loading problems associated with the potentiometric displacement 
transducers were avoided. 

• Direct conversion of the measurand into a digital signal precluded the requirement 
for an A D converter. (This would have been a disadvantage had the use of an 
analog signal conditioner been anticipated.) 

• Using two identical transducers, each capable of meeting the specifications for the 
pan axis, would reduce system complexity while still ensuring that the design spec- 
ifications were met. 



C. MOUNTING THE TRANSDUCER 

Once the decision to use an incremental optical shaft encoder was made, selection 
of a specific model remained. Before selection of an actual piece of hardware could be 
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Table 1. ANGULAR DISPLACEMENT TRANSDUCERS 



TR,ANSDUCER 

DESIGN 


RANGE 


RESOL- 

UTION 


LINEAR- 

ITY 


OTHER 


Reluctive 

Displacement 

(RVDT) 


o 

O 

'O 

1 

o 

o 


Theore- 
tically infi- 
nite; ' 

Limited by 
the signaT 
condi- 
tioner. 


Poor beyond 
±40’ ■ 




Reluctive 

Displacement 

(Farrand's 

INDUCTOSYN) 


0° -360’ 


+ (4 X 10^)’ 


Good 


Large size limits use- 
fulness with the cam- 
era measuring 
svstem. 


Capacitive 

Displacement 


0 

o 

1 

o 

o 

o 


Theore- 
tically infi- 
nite; 

Limited by 
the signaF 
condi- 
tioner. 


Good 


Temperature sensi- 
tive 


Potentiometric 

Displacement 


0» -3500’ 


Device 

dependent 


Device 

dependent 


The trade-off be- 
tween 

range resolution and 
linearity due to the 
loadine effect of the 
noninfinite 
impedance of the sig- 
nal conditioning de^ 
vices used. 


Absolute 

Encoders 


0’ -360’ 


360’ 


Good 


No A D conversion 
required. Insensitive 
to power shut-off. 


Incremental 

Encoders 


± OO 


o 

O 


Good 


Simple. Requires 
more signal process- 
ing than absolute en- 
co'der but is less 
expensive. 


n X PPR 



done though, one additional practical consideration had to be made; where and how 
could a transducer be mounted in or on the servo in order to measure the position of the 
Pan and Tilt axes? 

The physical layout of the camera positioning servo made direct connection of any 
type of transducer to the axes of interest virtually impossible without major modification 
of the servo itself Major modification of the servo would have been expensive, time 
consuming and outside the scope of this thesis. It was not considered an option in this 
case. .Measurement of the Pan and Tilt axes' displacements was most readily accom- 
plished indirectly. Each axis of the servo is positioned by a separate dc motor via a gear 
train. By mounting the shaft encoder code wheels to the sprockets (items 42 and 43 in 
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Figure 10) which are each attached to one of the worms, an indirect measurement of the 
position of each of the vvormgears (items 5 and 7 in Figure 10) was possible. This ap- 
proach, made necessary by the servo design, w^as a mixed blessing. 

The backlash in a worm-w'ormgear connection w'ill cause the position of the w’orm 
to be different for any given w'ormgear position, depending on whether that position is 
approached from a clockwise or a counterclockwise direction. In order to correctly de- 
termine the displacement of the wormgear by measuring the displacement of the worm, 
the amount of backlash present must be known (i.e., w^ould have to be determined ex- 
perimentally) and accounted for by the measurement system. This nonlinear source of 
error would not have been a concern if the servo w'as only required to rotate in one di- 
rection. This was not the case, however, and hysteresis eventually w'as determined to 
be the largest single source of error in the measurement system. A more complete dis- 
cussion of this topic is included in Chapter IV of this thesis. 

Assuming for the moment that the effects of the backlash in the gears could have 
been completely compensated for, mounting the shaft encoders on the w'orm provided 
a measurement advantage analogous to the mechanical advantage afforded by the gear 
train. Initial measurements indicated that each of the w'orms turned through 18,000° 
(50 X 360°) for every' 360° rotation of the corresponding w^ormgear. This meant that a 
shaft encoder with 100 divisions per 360° attached to the worm axis could do the same 
job as a 5,000 division per 360° encoder attached to the w’ormgear axis. 

D. SELECTING AN OPTICAL SHAFT ENCODER 

Once the basic decisions to use incremental optical shaft encoders and to mount the 
encoders on the worms inside the servo housing had been made, selection of the specific 
pieces of hardware was relatively straight forw'ard and was primarily a matter of con- 
venience and expediency. 

Returning to the design specifications for a moment; the most stringent requirement 
was to be able to measure the position of the pan axis to within ± (5.73 x 10'^)°. To 
determine the required resolution for the optical shaft encoder, the following calculations 
were performed. 

First, 



360°/Revolution Divisions 

T :==:62,827— ; — : . 

5.73 X 10“^°/Division Revolution 
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Then, considering the 50.T gear advantage, 



62.827 Divisions /o^ 

— — ==1257-7;^ ; — : . ( 8 ) 

oO Revolution 

The task therefore was to find an optical shaft encoder capable of detecting 
bidirectional rotation with at least 1257 Divisions/ Revolution in a package small enough 
to mount in the servo housing on the worm axis. There was no absolute size limitation; 
however, due to the construction of the servo it was desirable to find an encoder that 
was no more than 3 in. in diameter and no more than 1.5 in. in width. The companies 
that make shaft encoders are capable of custom building devices to meet a customer's 
specific needs. However, the prices are high, and the lead times are long for these special 
order parts. The encoder for this system needed to be reasonably priced and readily 
available to ensure timely completion of the project and to facilitate replacement, if 
necessaiy, in the future. 

Optical shaft encoders are manufactured by numerous companies including Litton, 
Hone\-well, BEl, IVO and Hewlett Packard. Sales literature from these companies was 
reviewed prior to making a decision on the specific shaft encoder model to be used. In- 
cremental optical shaft encoders with resolutions that range from one pulse per revo- 
lution (PPR) to 2540 PPR are available off the shelf from one or more of these 
companies. While evaluating sources of supply, incremental optical shaft encoders were 
also found in use in various laboratories and shops in the Electrical Engineering and 
Physics Departments at the NPS. Encoders immediately available from stock included 
two Vernitech 1200 PPR (model VOE-23-1200-AI-LD5-2L1 -1603-2) encoders from the 
Physics Department and two Hewlett Packard (HEDS-6000, J06) encoders from the 
Electrical Engineering Department. The use of the Vernitech encoders was ruled out 
because they were unable to detect bidirectional movement without increasing the com- 
plexity of the signal conditioning subsystem. Additionally, technical literature requested 
on two separate occasions from Vernitech was never received. 

The HEDS-6000;J06 encoders have a resolution of 1024 PPR. Each encoder pro- 
vides displacement information in the form of TTL logic level signals via two output 
channels. When the encoder is properly adjusted the two output signals have a 90° 
phase difference. This quadrature phase relationship permits these encoders to detect 
bidirectional displacements. Rotation in one direction will cause Channel A to lead 
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Channel B (in phase), while rotation in the other direction will cause Channel B to lead 
Channel A. [Ref. 9: p. 2] 

The presence of two output channels in quadrature phase has an additional benefit 
that is useful in some applications. Since the amount of position information has es- 
sentially been doubled, if the signal conditioner is designed to detect both the leading and 
trailing edges of one of the output channels the resolution of the measurement system 
can be doubled. The difficulty with using this technique is that multiple oscillations 
about a single point cannot be detected as such. If the camera were to oscillate less than 
one half of a pulse width about a transition the signal conditioner would detect and er- 
roneously count the multiple transitions. [Ref 7: pp. 13-16] 

With 1024 PPR, which is less than the 1257 PPR required to meet the O.I milliradian 
accuracy specification on the pan axis, the maximum resolution available, if the 
HEDS-6000 was attached to the worm, can be calculated as; 

T5ofTkr-(7'05'«x lO-V Pulse-' . (9) 

Although this was not sufficient to satisfy the pan axis resolution specification of 
(5.73 X 10“^)°Pulse,~‘ all of the other performance criteria could be satisfied. The trade- 
off seemed reasonable and was approved prior to proceeding further with the system 
design. 

E. THE DISPLAY 

Selecting a method to display the final system output was certainly the least de- 
manding task required in the design of the system. With an expected resolution on the 
pan axis of approximately 0.007° over a range of 360° (a ratio of about 1:51,500) an 
analog display seemed out of the question. A five or six digit digital display on the other 
hand offered a simple, reliable and cost efficient means of presenting the output. Con- 
structing the displays from individual, seven-segment, common anode, LED devices, and 
the appropriate display drivers was a straight forward task. 

F. THE SIGNAL CONDITIONER 

Anticipating the use of two incremental shaft encoders as the transducers for the 
measurement system and the use of digital readouts as the display devices significantly 
reduced the number of possibilities for the signal conditioning subsystem. In addition 
to the hardware and software described in each of the subsequent discussions, each 



technique listed here would require an edge detector to detect the transitions in the TTL 
signals from the shaft encoders. 

• Up'down counter with table look-up. 

• Up, 'down counter and multiplication. 

• Add; subtract. 

• Microcomputer. 

• .Microprocessor. 

1. Up/down (U/D) counter with table look-up 

This technique would involve the use of a shift register, some associated logic, 
an U/D counter and a table look-up device such as an erasable programmable read only 
memoiy (EPRO.M). The shift register would serve as a hardware buffer that could be 
used to account for the hysteresis introduced by the worm-wormgear assembly. The 
length of the buffer would have to be determined experimentally. The logic associated 
with the shift register would determine the “validity” of each transition (count) signal 
from the edge detector by checking the contents of the shift register and comparing the 
current direction of rotation with the previous direction of rotation. Whenever the logic 
detected a change in rotation direction, or a partially full, or a partially empty buffer 
(depending on the direction of rotation), the transition would not represent a “valid” 
count since any of these conditions would indicate that the transition was due to a 
change in the position of the worm without a corresponding change in the position of 
the wormgear. Thus, the present transition would be the result of hysteresis due to the 
backlash in the gear train and the transition would be “invalid”. Such a transition would 
cause the contents of the hysteresis buffer to be modified appropriately. A more com- 
plete discussion of this topic is contained in Chapter IV. The shift register and associ- 
ated logic could be built from common TTL devices readily available at the NFS. 

Once a count had been determined to be valid, an U/D counter would be used 
to keep a running total of the number of counts. Again, such a device could be built 
using readily available TTL devices such as the 74LS168.A., Synchronous 4-Bit Up, Down 
Decade Counter, or the 74LS169A, Synchronous 4-Bit Up, Down Binary Counter. The 
output from the U/D counter would then be used as an address to “look up” a prede- 
termined number stored in an EPRO.M. 

This design approach was considered relatively straightforward, and at least in- 
itially seemed like a viable option. Its major advantage was that it was conceptually 
quite simple. This simplicity had a price though; it would have been very' hardware in- 
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tensive and consequently would have been a very' inflexible design. For example, if at a 
later date the use of an arbitrary’ reference was desired, additional hardware would have 
to be added to the signal conditioner so that the counter could be initialized to the ar- 
bitrary starting point. Since all of the processing w’ould have to be done in hardware, 
even a minor modification in the system could necessitate a major design revision. An- 
other consideration was that saving in excess of 51,000 unique positions in the EPROM 
presented a nontrivial problem that would need to be solved if this technique was used. 

2. Up/down counter and multiplication 

This is very similar to the previous case, differing only in that instead of looking 
up a predetermined position, in a memory device, a multiplier would be used to multiply 
the output of the U, D counter by a predetermined constant. As an example, if exper- 
imental results indicated that the shaft encoders generated one pulse for every 
0.00703125° that the camera was displaced, then each time a valid count was received, 
the updated count would need to be multiplied by 0.00703125 in the final stage of the 
signal processor. The result would be the new position. Again, while conceptually 
simple this idea had some significant disadvantages. Even more hardware intensive than 
the first approach, this design would also have extremely limited flexibility. 

Accomplishing the multiplication would have posed a formidable task. The 
scale factor would have to be written as some integer (e.g., 0.00703125 would become 
703125, or 70323, or 7031, etc.) depending on the desired accuracy. The count, already 
an integer, would be multiplied by the constant and the correct position of the decimal 
point would have to be determined. Locating the decimal point would be a relatively 
simple task, but multiplication of two numbers such as 51,000 and 70,313 would not be 
as easy. At least one 16 bit by 16 bit binary multiplier (i.e., TRW's MPY016H) is cur- 
rently available, but since the number 70313 cannot be represented in binary by less than 
17 bits, the multiplication could have been accomplished in either of two ways. One 
solution would have been to perform the multiplication in two or more stages. Alter- 
natively, 70313 could be “rounded” to 7031. The second option would create a cumu- 
lative round-off of about (1.28 x 10’^)° per 360° rotation (assuming 51,200 pulses per 
360° ). This round-off error would probably have been acceptable, but the complexity 
and limited flexibility of either multiplication scheme made the U/D counter and multi- 
plication an unacceptable candidate for the signal processing subsystem. 

3, Add/subtract 

A third design concept considered the elimination of the L','D counter alto- 
gether. The same logic proposed for use in the previous two designs could have been 
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used to check the validity of a count and to determine the direction of rotation. How- 
ever, instead of valid counts being sent to an U/D counter as before, these counts would 
now signal an adder to add or subtract a predetermined constant from the running total. 
Just as before, this simple idea could probably have been made to work at least once, 
but its usefulness as a part of a larger system would certainly have been limited. The 
large number of components required to realize this design would have increased the 
probability of failure, complicated troubleshooting and reduced overall flexibility. 

4. Microcomputer 

If the signal processing subsystem was built around a microcomputer (PC), vir- 
tually all of the disadvantages associated with the previously discussed approaches would 
be eliminated. Since all of the logic could be implemented in software, modifications to 
the system would be relatively simple to make, and the system's flexibility would be en- 
hanced. However, dedicating a microcomputer, even an ine.xpensive model, to the signal 
processing tasks for this measurement system was considered overkill, and timesharing 
with one of the PC's already in service was possible, but not considered practical or 
convenient since these microcomputers had already been dedicated to a variety of tasks. 

5. Microprocessor 

One final option for the signal processor remained. Microprocessors are rela- 
tively inexpensive and powerful and are available in a wide variety of makes and models. 
If a microprocessor was used instead of a microcomputer or a straight hardware 
processor, the “nice to have” requirements such as flexibility, ease of modification and 
capacity for expansion, as well as the required signal processing functions could all be 
satisfied. On the other hand, microprocessors have one distinct disadvantage; they are 
not user friendly. The use of a microprocessor implied countless hours spent tracking 
individual bits, debugging assembly language code, studying timing diagrams, etc.. Xo 
matter how distasteful the thought, however, a microprocessor was clearly the best way 
to perform the signal processing functions of the measurement system. 

As with the selection of the transducer, once the basic design approach had been 
determined, selection of a specific device was a relatively straight forward task. The 
choice of one microprocessor over another was a function of the processor's ability to 
perform the required tasks, cost effectiveness and availability. Motorola's MC68705U3 
seemed to satisfy all of these requirements. The MC6S705U3 is a four kilobyte EPROM 
microprocessor, built using HMOS (high-density NMOS) technology with an eight bit 
architecture. The “68705” operates on a 5.0 volt dc supply, has 112 bytes of on chip 
R.^.M, four vectored interrupts, 24 TTL.'CMOS compatible bidirectional 1;0 lines (eight 
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lines are LED compatible), eight dedicated input lines and an internal eight bit timer 
with a seven bit programmable prescaler. [Ref. 10: p. 1] 

In Ref 10 Motorola advertises the following software features: 

• Programming language similar to the 6800 family. 

• Byte efficient instruction set. 

• Easy to program. 

• True bit manipulation. 

• Bit test and branch instructions. 

• Versatile interrupt handling. 

• Powerful indexed addressing for tables. 

• Versatile index register. 

• A full set of conditional branches. 

• .Memory usable as registers, flags. 

• Single instruction memoiy examine/change capability. 

• Ten powerful addressing modes. 

• All addressing modes apply to EPROM, RAM and 1,0. 

One key advantage to using the MC68705U3 was that one of the micro- 
processors. and a Motorola M68705EVM (the evaluation, programming module for the 
M6805 family of devices) were both available for immediate use at the NPS. The fact 
that the 68705 utilized HMOS technology suggested that it should be a relatively low 
cost microprocessor. In fact, except for the price of a phone call, a second micro- 
processor was obtained free of charge from a local electronics wholesaler. Additional 
microprocessors, to be used as replacements and as backup devices were ordered for 
about S20.00 each. 

One potential problem with using a microprocessor begged checking prior to 
proceeding. Initial measurements of the camera's maximum rotation velocity produced 
the following results. 



'PAS(m^)- LOrpm 


(10) 


TILT (max) ~ 


(11) 



Again the requirements for the pan axis presented the most stringent design limitations. 
Since the optical shaft encoders were anticipated to deliver 51,200 PPR ( 1024 x 50) the 
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microprocessor on the pan axis had to be capable of processing 51,200 pulses 'minute 
(1.172 ms / pulse). The MC68705U3 is designed to operate with an oscillator frequency 
(/^„) of between 0.4 MHz and 4.4 MHz and has an instruction cycle time (4/4,^) of be- 
tween 0.950 ^s and 10 /zs. Assuming that a 4.0 MHz clock was used, the instruction 
cycle time would be 1.0 /iS. This would mean that the processing of each pulse would 
have to be accomplished in no more than 1172 instruction cycles to ensure that no pulses 
would be missed. 
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III. DESIGN 



A. GENERAL 

The schematic diagrams for the measurement system are shown in Appendix A; 
Appendix B contains copies of the printed circuit board plans. Before describing the 
detailed operation of each of the individual components of the measurement system, a 
brief overview of its basic theory’ of operation is in order. The measurement system is 
actually two separate systems operating independently. The system designed to measure 
the azimuth or pan angle will subsequently be referred to as the “Pan System”, and the 
other system, designed to measure the elevation or tilt angle, will be referred to as the 
“Tilt System”. However, because the two systems are quite similar the discussion which 
follows will only specifically describe the operation of both systems where their opera- 
tion differs. 

In the most general terms, the measurement system shown in Figure 2 on page 6 
uses two microprocessors to count the pulses generated by the incremental shaft encod- 
ers, and to provide output signals to the display devices. The counting function per- 
formed by each microprocessor involves determining the direction of rotation and 
determining whether each count is "valid”. Valid counts are encoder pulses which result 
from the displacement of the camera servo, while invalid counts are a result of the 
hysteresis in the gear train. The number of valid counts is directly proportional to the 
angular displacement of the camera axis. 

Both of the displays are capable of presenting the position information in two basic 
forms. In the Count Mode they display the number of pulses that have been detected, 
and in the Position .Mode they display the angle in degrees that the number of pulses 
represents. A third display mode, which is a combination of the first two, is also avail- 
able. In the third mode, referred to as the “Blinking .Mode”, the display will alternately 
display the count and the angle. 

B. SHAFT ENCODER AND LINE DRIVER 

Figure 1 1 shows the basic components of the HEDS-6000 incremental optical shaft 
encoder. The encoder is approximately 56 mm in diameter and 20 mm deep. The code 
wheel assemblies for the HEDS-6000 J06 encoders are designed to mount on 0.25 in. 
shafts. Since the mounting surface shown in Figure 1 1 is not part of the encoder kit, 
and did not existed on either of the worm axes, two such surfaces were machined in the 



28 



Physics Department Shop and attached to one end of each of the worms. Each surface 
has a 0.25 in. diameter shaft to which one of the code wheel assemblies is attached. Two 
sheet metal brackets, also made in the Physics Department Shop, are bolted to the servo 
frame. The encoder bodies are mounted to these brackets. Figure 12 shows the shaft 
encoders mounted in the camera servo. [Ref 9: p.l] 




Figure 11. HEDS-6000 Series Encoder Kit: From Ref 9: p.6. 

Also seen in Figure 12 is a printed circuit board mounted between the two optical 
shaft encoders. Each of the encoders is electrically connected to the board via a separate 
ten wire ribbon cable. The power and the output signals from the shaft encoders are 
transmitted through these cables. A sketch of the ribbon cable connector and the pinout 
for the connector are shown in Figure 13. Each connector is attached to a ten pin 
header on the printed circuit board. Pins 2, 7 and 9 are connected to a +5.0 Vdc power 
supply external to the camera servo. A description of the power supply is given later in 
this chapter. Pins 3, 4, 5 and 6 are connected to the power supply ground. The 
HEDS-6000 does not have an index pulse, therefore pin 10 is not connected. 

The remaining two pins on each header connect the output channels of the shaft 
encoders to two 74S140 line drivers. Each 74S140 is a dual four-input NAND gate 
50-Ohm line driver. The line drivers are powered by the same supply as the encoders. 
They serve as bulTers between the encoders and the transmission lines which are used to 
transmit the encoder signals to the signal conditioner. The line drivers' typical high 
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Figure 12. Modified Camera Servo: (a) Optical shaft encoder used to measure 
Pan axis displacement, (b) Optical shaft encoder used to measure Tilt 
axis displacement, (c) Ribbon cable, (d) Printed circuit board. 



output current is 10 mA and the maximum is 18 mA. Resistance in the transmission 
line was measured to be approximately 35 O, and to be on the safe side a 10 O con- 
nector loss was assumed. The voltage drop due to an 18 mA current through a 45 O 
resistance is 0.81 V. A “voltage high” signal received at the signal conditioner should 
therefore be about 4.19 V. This is well above the maximum, positive-going threshold 
voltage specification of 2.0 V for the 7414 Schmitt triggers, which are used to receive the 
signals at the signal processor. (Ref 11; pp. 5-73, 5-74, 6-44] 

C. ENCODER-MICROPROCESSOR INTERFACE 

The signals transmitted by the two line drivers are Channels A and B of each of the 
shaft encoders. These signals contain the raw data which the signal processor converts 
into position information. Three pairs of multiple pin connectors are used in the 
encoder-microprocessor interface. The pinouts for these connectors are shown in 
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PINOUT 



PIN > FUNCTION 

1 CHANNEL A 

2 Vcc 

3 GROUND 

4 NX. OR GROUND 

5 NX. OR GROUND 

6 GROUND 

7 Vcc 

• CHANNELS 

9 Vcc 

10 CHANNEL I 



Fi gure 13. Encoder Connector Specifications: From Ref. 9: p. 6. 

Figure 14. Each of the four signals is received at the signal processor by a 7414 Schmitt 
trigger which is used to “clean up” the signal. The Schmitt triggers lower the system's 
susceptibility to errors caused by slow state transitions and increase the signals' fan out 
capabilities [Ref 7: p. 13). 

The output of each Schmitt trigger is routed to an input port of the appropriate 
microprocessor. Each Channel A signal is also the input to an edge detector. The edge 
detectors each consist of three 7414 inverters, a 74LSS6 EXOR gate and a 47 nF 
capacitor, configured in the manner shown in Figure 15. This configuration causes the 
interrupt line to go low for approximately 2 ns each time Channel A transitions from 
low to high or from high to low. Since an oscillator frequency, X jc of 4.0 .MHz is being 
used, the interrupt pulse width, t>^i, must be greater than or equal to 1.25 /rs [Ref 10: 
p. 3]. The value of the capacitor required to achieve the 2 //s delay was determined ex- 
perimentally. 

D. SWITCHES 

The measurement system has 10 switches that allow the operator to control specific 
functions of the signal processors and the displays. Figure 16 shows the physical lo- 
cation of these switches on the control panel. Switches SWl(P) and SWl(T) control the 
reset lines to the microprocessors. Switches SW2(P), SW2(T) and SW5 control the dis- 
play mode. The Function and Set switches; (SW3(P), SW3(T), SW4(P) and SW4(T)) 
allow the user to change the length of the hysteresis buffer in the microprocessor. The 
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Figure 14. Encoder-Microprocessor Connector Specifications 
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Figure 15. Interrupt Interface: After Ref 7: p. 14. 



master power switch is SW6. Table 2 identifies the switches by name, description and 
function. 

Any mechanical switch will “bounce’’ or “chatter” when it is thrown, and since the 
operation of the signal processor depends on the number of times that the Display Mode 
and Set switches change position, these switches had to be “debounced”. A ver}' simple 
but effective way to do this is with an RS latch. Switches SVV2(1’), SVV2(T), S\V4(P) and 
SW4(T) are each debounced in this manner. Each latch is made from two 74SOO NAND 
gates connected in the manner shown in Figure 17. [Refs. 13: pp. 132-135, 12 : pp. 3,4] 
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Figure 16. Control Panel 



E. MC68705U3 
1. General 

The two 40 pin MC6S705U3 microprocessors (MPU's) are the heart of the 
measurement system. With the exception of the light test signal, eveiy signal in the 
system is either part of the input to one of the .MPU's or part of their output. The 
MPU's were programmed using the assembly language syntax, assembler directives and 
instruction set for the M6S05 family of microprocessors which are described in Ref 14. 
The Pan and Tilt programs are listed and their operation is described in Appendix D. 
The pin assignments for the MC6S705U3 are shown in Figure IS. Table 3 briefly de- 
scribes the purpose of each pin and the actual connections for the two MPU's. 
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2. Memon' Map 

a. Input! Output (IjO) 

The memon’ map for the MC68705U3 is shown in Figure 19. The digits 
following a “S” are the hexadecimal representation of the address for a specific memor}’ 
location. The data registers occupy the first four memor>’ locations of each MPU. Thus 
the information written into the registers at SOOO, SOOl and S002 is written to the output 
ports A, B and C respectively. Port D, at address S003, is an input only port as indicated 
in Table 3. In order to determine the state of the input lines, the contents of the register 
at S003 must be read by the MPU. Registers S004, S005 and S006 are the data direction 
registers (DDR's) for Ports A, B and C respectively. Because all three ports are used as 
“output only” ports, in this application, the DDR's are all established as such by an 
initialization routine performed by the .MPU's during their initial power-up and after 
each external reset. [Ref 10: pp. 5, 12, 14] 

Pin 18 of the .MPU can be used as either a general purpose input line or as 
an interrupt line. The primaiy interrupt line on each MPU is used to signal the occur- 
rence of a state transition on Channel A. Pin 18 is used as a second interrupt line to 
signal a display mode change request from the operator. The Miscellaneous Register 
(.MR) at address SOA is used to control the operation of the second interrupt line 
(1NT2) . In order to establish pin 18 as an interrupt line, bit 6 of the .MR is cleared by 
the Initialization Routine. The 1NT2 Interrupt Request Bit, bit 7 of the .MR, is cleared 
by default upon reset. It is set when a falling edge is detected on the Display .Mode line 
which is connected to pin 18. When this occurs and bit 6 of the .MR is cleared, an in- 
terrupt request is generated. This interrupt request causes the display mode to change. 
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Table 2. SIGNAL PROCESSOR AND DISPLAY SWITCHES 



NAME 


DESCRIPTION AND FUNCTION 


PAN RESET 
(SWI(P)) 


Momentar>' action push button switch: Resets the Pan 
Microprocessor. Causes the Pan Display to be reset to 
zero. 


TILT RESET 
(SWl(T)) 


Same as SWl(P) except it affects the Tilt System only. 


PAX DISPLAY MODE 
(SW2(P)) 


Single pole double throw toggle switch; Each time the 
switch position is changed the Pan Display toggles from 
Count mode, to Position Mode, to Blinking Mode, to 
Count Mode, etc.. 


TILT DISPLAY MODE 
(SW2(T)) 


Same as SW2(P) except it affects the Tilt Display only. 


FUNCTION 

(HYSTERESIS) 

(SW3(P)) 


Single pole double throw switch: When closed, causes 
the “Function” line of the Pan Microprocessor to go 
low and causes the size of the hysteresis buffer to be 
displayed on the Pan Display. Enables SW4(P). 


FUNCTION 

(HYSTERESIS) 

(SW3(T)) 


Same as SW3(P) except it affects the Tilt System only. 


SET HYSTERESIS 
(SW4(P)) 


Single pole double throw switch: Inoperable unless 
SW3(P) is closed. If SW3(P) is closed, each time the 
position of SW4(P) is changed the length of the 
hysteresis buffer is incremented by one. .Vlaximum 
buffer length is 25. Toggling SW4(P) when the buffer 
length is 25 will cause the buffer length to be reset to 
zero. 


SET HYSTERESIS 
(SW4(T)) 


Same as SW4(P) except it affects the Tilt Hysteresis 
buffer. 


LIGHT TEST 
(SW5) 


Single pole single throw switch: When closed, lines I, 
2. 7, 8, 10, 11 and 13 on each of the LED displays will 
go low. Unless an element is burned out, every digit in 
both displays should be an eight. 


POWER 

(SW6) 


Single pole single throw switch; When closed, applies 
+ 5.0 V dc power to the signal processors and the dis- 
plays. 
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MC68705U3 Pin assignments: From Ref. 10: p. 1. 



Once bit 7 has been set by an interrupt, it must be cleared by software to avoid repeated 
and unwanted interrupts from occurring. This task is performed by the Mode Change 
Routine in each EPROM. [Ref 10: pp. 1, 10, 13, 15] 
h. Timer 

The operator can cause either or both of the displays to “blink” by using 
the Display Mode Switches, SW2(P) and SW2(T). When one of the systems has its 
display in the Blinking Mode, the associated MPU uses its timer to generate a timer in- 
terrupt request every second. The interrupt request causes the MPU to execute the 
Mode Change Routine. A block diagram of the timer is shown in Figure 20. The timer 
consists of an eight-bit counter which is decremented toward zero by the fcis input. 
When the counter reaches zero, it sets the Timer Interrupt Request Bit (TIR) of the 
Timer Control Register (TCR), and a timer interrupt request is generated unless the 
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Timer Interrupt Mask Bit ( I IM) of the I CR is set. A brief description of each of the 
timer registers and their configuration follows. 

(1) Timer Data Register (TDR). I he I DR is the eight-bit counter 
which sets the 1 IR bit of the TCR when it decrements to zero. 

(2) Timer Control Register. I hc contents of the ICR determine the 
general operation of the tinier. 

• Bit 7, Timer Interrupt Request (TIR), signals a 1 DR underilow when it is .set and 
will cause a timer interrupt request if the TIM bit of the TCR is clear. I he TIR 
is cleared by the MPU reset or by program control. 

• Bit 6, Timer Interrupt Mask (I IM), inhibits a timer interrupt request when it is set. 
It is set by external reset or program control to inhibit the Blinking Mode, and is 
cleared by software w'hen the Blinking Mode is lequcsted by the operator. 

• Bit 5, External or Internal Clock Select (TIN), is used to select the timer clock 
source. Since the internal clock is used in this application, the flN bits of both 
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Table 3. MPU CONNECTIONS 



Pin 


Name 


Description 


1 


V 55 


Ground 


2 


RESET 


When RESET is pulled low program execution halts, all variables are 
reinitialized and the Pan display is set to zero. SWl(P) controls the 
RESET line on the Pan .MPU. 


3 


I NT 


Allows asynchronous interruption of the processor. When INT is 
pulled low by the Count Edge Detector the .MPU executes the 
“Count Routine”. 


4 


Vcc 


+ 5 V dc power connection. 


5 


EXTAL 


External clock input. Connected to a 4.0 MHz external clock which 
provides the MPU system clock. 


6 


XTAL 


Crystal clock input. Connected to ground since an external clock is 
used. 


7 


\pp 


Programming voltage pin. Connected to V^c for normal operation. 


8 


Timer 


E.xternal timer control input. Connected to Ycc since the internal 
timer is used. 




Port C 


General Purpose I'O lines. 


9 


PCO 


The two least significant digits in the display are represented in bi- 
nary coded decimal (BCD) by these eight lines. 


10 


PCI 


11 


PC2 


12 


PC3 


13 


PC4 


14 


PC5 


15 


PC6 


16 


PC7 




Port D 


General Purpose input lines. 


17 


PD7 


PD7 is the Channel A input to the .MPU. 

PD6 is used as a second interrupt line. 

When PD6 goes low the .MPU changes display modes. 

PD5 is the Channel B input into the MPU. 

PD4 is the Function input into the .MPU. 

PD3 is the Set input into the MPU. 

PD2-PD0 are not used and are tied to ground. 


18 


PD6 

INT2 


19 


PD5 


20 


PD4 


21 


PD3 


22 


PD2 


23 


PDl 


24 


PDO 



39 



Table 4. MPU CONNECTIONS (CONPD.) 



Pin 


Name 


Description 




Port B 


General Purpose I'O lines (LED compatible). 


25 


PBO 


The most significant digit is represented in BCD by PB0-PB3 except 
on the Tilt .MPU where these lines are connected to ground. 

PB4 determines which digits in the display are blanked. 

PB5 is not used. Connected to ground. 

PB6 determines the presence or absence of the display minus sign. 
PB7 determines the presence or absence of the display decimal point. 


26 


PBl 


27 


PB2 


28 


PB3 


29 


PB4 


30 


PB5 


31 


PB6 


32 


PB7 




Port A 


General Purpose 1,0 lines. 


33 


PAO 


The third and fourth least significant digits are represented in BCD 
by these eight lines. 


34 


PAl 


35 


PA 2 


36 


PA3 


37 


PA4 


38 


PA5 


39 


PA6 


40 


PA7 



MPU's are alwavs cleared. For the same reason the Timer pins are connected to 
V’cc (see Table 3). 

• Bit 4. External Enable (TEE), is not used by the measurement system. By keeping 
the TEE clear at all times, the 68705's internal timer is used exclusively. 

• Bit 3, Prescaler Clear (PSC), is not used in this application; always cleared. 

• Bits 2-0, Prescaler Select (PS2, PSl and PSO), are always set during program exe- 
cution. This causes the internal timer signal frequency to be divided by 128. 

(i) Mask Option Register (MOR). Unlike the TDR and TCR the .MOR 
is not software programmable; instead, it is implemented in EPROM. 

• Bit 7, the Clock bit, is cleared to allow operation of the e.xternal 4.0 .MHz clock. 

• The Timer Option bit (TOPT), bit 6, is also cleared in this application. This per- 
mits the TCR to be software programmable. 

• Bit 5 is cleared to permit the use of the internal clock with the timer. 

• Bits 4 and 3 are not used. 
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Figure 20. 



MC68705U3 Timer Functional Block. Diagram.: From Ref. 10; p. 8. 
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• Bits 2-0 are all set and serve the same function as PS2, PSl and PSO bits of the 
TCR. [Ref 10: pp. 6-8, 13-15] 

3. RAM 

The MC68705U3 has 112 bytes of RAM. The 112 bytes includes 31 bytes that 
can be used for the stack. Use of the stack is quite limited. During interrupts it is used 
to save the contents of the CPU registers and the program counter. During subroutine 
calls only the program counter is saved. The user's program has no other access to the 
stack. The programs written for each of the MPU's require less than 25% of the avail- 
able RAM. The Pan MPU uses 27 of the 112 available bytes and the Tilt MPU uses 
only 22 bytes. The programs listed in Appendix D explain the function and give the 
location in memory for each of the variables. [Ref 10: p. 5] 

4. ROM 

The 3776 bytes of user EPROM in the MC68705U3 are divided into three sep- 
arate blocks in the memor}'. Page Zero User EPRO.M is the ROM located between ad- 
dress SOSO and SOFF. Because these addresses are only one byte long, instructions 
located in Page Zero ROM can be referenced with addressing modes not permitted with 
instructions located in other parts of the memor\'. Between address SlOO and SF37 is the 
User .Main EPRO.M. This portion of the memory in each MPU contains the vast ma- 
jority of the signal conditioning programs. Located in another portion of the EPROM 
are the Interrupt Vectors. In each of these locations is the address of the first instruction 
the MPU is to execute when a particular interrupt occurs. 

As with the R.AM only a fraction of the available EPRO.M has been used in this 
application. The Pan MPU uses 899 bytes of the 3776 available and the Tilt MPU uses 
only 767 bytes. Since both programs are so small, one could reasonably ask why the two 
programs were not both put in one MPU. The primary problem with this idea is that 
each microprocessor can perform only one operation at a time. As indicated at the end 
of Chapter 11, if the camera servo is rotating about its vertical axis at its maximum ve- 
locity of 1 rpm, the Pan signal conditioner must be capable of counting and displaying 
51,200 counts per minute. Using a 4.0 .MHz clock this allows the MPU 1 172;US to count 
each pulse. Similarly the Tilt .MPU has 1758/iS to count each pulse when the camera is 
rotating at its maximum velocity about the horizontal axis. Assuming that the camera 
is rotating at its maximum velocity on both a.xes at the same time, and one .MPU is being 
used to count the pulses from both encoders, the MPU needs to count 76.800 pulses per 
minute, which only allows 78 1.3 ns per pulse. The Pan .MPU currently requires a max- 
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imum of 1032 instruction cycles or 1032AiS to count a single pulse, and the maximum 
execution time for a single pulse on the Tilt axis is 825;xs. Thus, a single 68705 lacks the 
computational speed required to ensure that no counts would be missed if it was used 
to process the data from both encoders. 

5. Central Processing Unit (CPU) 

The CPU of the M6805 Family is implemented independently from the I/O or 
memory configuration. Consequently it can be treated as an independent central 
processor communicating with I/O and memory via internal address, data and con- 
trol buses. [Ref 10; p. 6] 

The CPU has five registers that are available for use by the operator. The 
function of each of these is described below. 

• The Accumulator (A) is a general purpose data register used for arithmetic calcu- 
lation and data manipulation. 

• The Index Register (X) can be used as a second accumulator but is generally used 
for the indexed addressing mode. In the indexed addressing mode an effective ad- 
dress is created by adding the contents of X to a number provided by the instruc- 
tion. 

• The Program Counter (PC) contains the memory’ address of the next instruction to 
be executed by the ,MPU. 

• The five bits of the Condition Code Register (CCR) keep information concerning 
the results of the last instruction executed by the MPU. Reference 14 gives a de- 
tailed description of each of the instructions in the M6805 Family Instruction Set 
and explains the effect of each instruction on the CCR. A brief description of each 
bit in the CCR follows. 

■ The Carry (C) bit is set if a carr>' or a borrow was generated by the last arith- 
metic instruction. The state of the C bit can be software controlled. 

■ The Zero (Z) bit is set if the result of the last arithmetic, logic or data manipu- 
lation instruction was zero. 

■ The Negative (N) bit is set if bit seven of the result of the last arithmetic, logic, 
or data manipulation instruction is set. 

■ The Half Carry (H) bit is set if an ADD or an ADC instruction causes a carry 
to occur between bits 3 and 4 of the result. 

■ The Interrupt Mask (I) bit is set when an extern al inte rrupt (INT) occurs. If 
another interrupt occurs (e.g. Timer Interrupt or 1NT2 ) when the I bit is set, 
the second interrupt is latched so that it can be processed as soon as the I bit 
is cleared. The I bit can be set or cleared by software. 

• The contents of the Stack Pointer (SP) are the address of the next available location 
on the stack. As previously discussed, the stack is only used to keep track of the 
PC during subroutine branches, and all of the CPU registers during an interrupt. 
[Refs. 10: p. 6, 14 : pp. 14-15] 
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6. Input 

Each MPU uses six input lines. Two of these lines, INT and INT2 , are inter- 
rupt lines that detect a negative-going edge on their respective lines. The other four lines 
are general purpose input lines on Port D. All of the pins on Port D are TTL compatible 
which made the hardware design relatively straightfor^x'^ard. The electrical character- 
istics for the input pins are listed on p. 2 of Ref 10. 

The general operation of the two interrupt lines is described in Table 3 on page 
39. Once they are understood, interrupts are a simple yet powerful tool. Only three of 
the four interrupts available on the MC68705U3 are used by the Pan and Till programs. 
The software interrupt is not used. When the MPU is interrupted, current program ex- 
ecution is halted, the contents of the CPU registers are placed on the stack, and the 
MPU fetches the contents of the appropriate interrupt vector from memory. After the 
interrupt vector has been fetched, the PC is moved to that address and execution of the 
interrupt routine begins. There is no ambiguity when an external interrupt occurs since 
there is a dedicated interrupt vector in memor>'. The timer interrupt and IXT however 
share the Timer Interrupt Vector. When one of these interrupts occurs, the interrupt 
routine must determine the source of the interrupt by checking the TIR bit of the TCR 
and bit 7 of the MR to determine the source of the interrupt [Ref 10: p. 11]. Normal 
program execution resumes at the point at which the interrupt occurred when the inter- 
rupt routine executes a return from interrupt (RTI) instruction. 

The Function and Set lines on pins 20 and 21 are connected to the Function and 
Set switches. The operation of these switches is described in Table 2 on page 36. The 
remaining two input lines to each MPU are Channels A and B from the respective shaft 
encoders. The MPU programs use the information from these two inputs to determine 
the direction of rotation and to identify repeated oscillations about a single transition. 

7. Output 

Each MPU is designed to provide position information at its output in two basic 
forms. On the Pan axis, in the Count Mode a number between -51,200 and +51,200 
constitutes the output while in the Position Mode the output is an angle between 0° and 
360°. A five digit display with a minus sign is sufficient for the count display. Using a 
five digit display with a decimal point in the Position .Mode permits the angle to be dis- 
played to the nearest hundredth of a degree. This resolution is not quite as good as the 
resolution of the shaft encoders (±0.007°); however, final testing of the measurement 
system revealed that resolution is actually limited to about + 0.02° on the Pan axis and 
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about ±0.14“ on the Tilt axis. The five digit display is therefore completely adequate 
for this system. 

The Pan .MPU uses 23 of its 24 output pins to represent the five digits, a minus 
sign and a decimal point. Each of the five digits is available in BCD form on four output 
pins of the .MPU. The five digits are referred to as Digit 1, Digit 2, etc., with Digit 1 
being the least significant digit and Digit 5 being the most significant digit. Port A has 
as its output the BCD representation of Digit 3 and Digit 4. Digit 1 and Digit 2 are 
represented by the output of Port C. The low four bits of Port B contain the BCD 
representation of Digit 5. These 20 output hnes are the input to five 74LS47, 
BCD, '7-Segment Decoder/Drivers, which decode the BCD signals and driv'e the common 
anode LED indicators. The output from Pin 29, PB4, is one input to a 74LS32 OR gate, 
the output of which is used to blank leading zeros out of the display. Pin 30 is not used 
and is tied to ground. The remaining two output pins drive two LED segments in the 
display. The signal on pin 31 turns the minus sign off and on, and the signal on pin 32 
determines whether the decimal point is displayed. 

The electrical characteristics of the 1,0 Ports are given on p. 4 of Ref 10. The 
output characteristics of Ports A, B and C are compatible with the input characteristics 
of the 74LS47 and the 74LS32 given on pp. 4-59 and 4-48 of Ref II. The pins on 
Port B are capable of sinking 10 mA when Port B is configured as an output port. A 
220 Q resistor placed in series with each of the display segments limits the current to 
approximately 9 m<\ and permits the MPU to drive the decimal point and minus sign 
directly. 

One consideration in the design of this system was to provide a system capable 
of being readily expanded to meet changing needs. To this end, in addition to being 
connected to the LED display devices via the 74LS47's, the BCD data lines are also 
connected to a header on each of the MPU circuit boards. If at a later date, the posi- 
tion information needs to be used in another system, a jumper connected to each of the 
headers could provide the information with little or no modification. 

The Pan and Tilt signal processing subsystems are vinually identical in the 
hardware used to implement them. The only difference is that the Pan system has a five 
digit display, and the Tilt system needs only four digits to display its position informa- 
tion. Consequently, the Tilt system does not use Digit 5, and pins 25-29 are tied to 
ground. 
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F. DISPLAY 



Each digit represented in BCD at the output of the MPU is decoded by a 74LS47 
BCD '7-Segment Decoder/Driver. The decoding devices each convert a four bit BCD 
representation of a number into seven signals that each drive a separate segment of a 
common anode, seven segment, LED display. The 74LS47 is capable of sinking 24 mA 
from each of the LED segments. Without a current limiting resistor between each of the 
output pins on the 7447 and the corresponding pin on the display element however, this 
maximum current is exceeded. When this happens the LED's have a ver>' short life, the 
7447 overheats and the system fails to function properly. The addition of a 220 £2 re- 
sistor in each branch limits the current to about 9 mA per segment, and permits 
trouble-free operation. 

Three of the output pins on each MPU are not used as inputs to the 7447's. As 
discussed in the previous section, the Decimal and Minus lines each drive individual 
LED segments directly. The third line, also mentioned briefly in the preceding section, 
is used with the Blanking In, Ribbon Blanking Out (Bl, RBO) signal from Digit 4's 7447 
to determine the Ribbon Blanking In (RBI) signal into the 7447 which drives the display 
for Digit 3. 

The term “blanking” simply means remoting the leading zeros from the display. 
The two display modes available from the MPU's have different blanking requirements. 
In the Position Mode the three least significant digits are not blanked, while in the 
Count .Mode, all but the least significant digit are blanked. The RBI and BI/RBO pins 
on the 7447's, the Blank line out of each .MPU and the OR gates, connected as shown 
in the schematics in Appendix A, provide this capability. 

The Light Test (LT) pin on each 7447 is connected to SW5. When the switch is 
closed, the Light Test line goes low and each of the output lines on each of the 7447's 
also goes low, thus sinking current from all of the LED segments simultaneously. This 
feature allows the operator to check for inoperable display segments. 

G. POWER SUPPLIES 

The two power supplies shown in Figure 2 on page 6 are each -i- 5.0 Vdc supplies. 
The power supply which provides power to the shaft encoders and the line drivers is 
physically mounted in the camera housing. It was built by modifying the + 12 Vdc auto 
iris power supply. This was accomplished using an LM7805 Voltage Regulator in the 
manner shown in Figure 8 of Appendix A. The auto iris requires only 100 m.A at 
-I- 12 Vdc for correct operation, and the LM7812 Voltage Regulator has an available 
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output current of I.O A (Refs. 15, 16]. Ihe remaining 900 niA is available to the 
LM7805 to power the encoders and the line drivers. Reference 9 lists the maximum 
power requirement for the llEDS-600 as 40 mA at +5 Vdc, and Ref 11 specifies the 
maximum power requirement for a 74S140 is 1 niA at +5 Vdc. 'fhus, the 84 niA re- 
quirement for the two encoders and four line drivers is well w'ithin the capabilities of the 
modified power supply. 

The second power supply is capable of providing 6.0 A at + 5 Vdc which is more 
than adequate to provide the 1.4 A needed by the signal processors and the display de- 
vices. The power supply also has 12 Vdc and -5 Vdc ports. To preclude the potentially 
disastrous results which might occur if the power supply were incorrectly connected to 
the signal processor/display devices, the circuitry showm in Figure 21 was included on 
each MPU and display printed circuit board. 
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Figure 21. Reverse/Over-voltage Protection Circuit 
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IV. CALIBRATION , TESTING AND IMPLEMENTATION 



A. GENERAL 

Once the basic system design had been completed, and the MPU programs had been 
written, a prototype system was constructed. The prototype system might also be called 
the development model, since it was not only used to test the design , but was also used 
to calibrate the MPU programs. A block diagram of the prototype system is shown in 
Figure 22. The M68705EVM Evaluation Module (subsequently referred to as the 
EVM) provided the capability to debug and evaluate the MC68705U3-based signal 
processing subsystem. Operation of the signal processing MPU was performed by an 
MC68705U3 resident on the EVM. 

The prototype system provided considerable flexibility in the testing and calibration 
of the system. The assembly language programs for the MPU's were written and edited 
on the PC. They were then assembled and linked using the 2500 A.D. 6805 Cross As- 
sembler and 2500 A.D. Linker [Ref 17; pp. (l-l)-(2-38)]. The result, a Motorola S19 
output file (see [Ref 17; pp. (A-1 )-(A-4)j), was then down-loaded to the EVM using the 
file transfer program, Kermit. Downloading procedures are detailed in [Ref 18: pp. 
(3-10)-(3-25),(3-37)j. The PC-EVM interface is shown in Figure 23. 

After the program had been down-loaded into the MC68705U3 resident on the 
EV.M, data entry and program debugging were controlled via the CRT monitor key- 
board. The CRT-EVM interconnection is shown in Figure 24 and the monitor com- 
mands are described in [Ref 18: pp. (3-8)-(3-25)j. 

The remainder of the signal processing functions were realized using hardware e.x- 
ternal to the EVM. These functions included edge detection of the output signals from 
the shaft encoders, decoding the output of the MPU, and generating the signals to drive 
the display devices. This portion of the prototype, referred to by [Ref 18) as the “target 
system”, was built on breadboards and is represented by the block in the center of 
Figure 22. The target system was connected to the .MCU via a 40-pin jumper header, 
Jl, on the EVM. The pinout for J1 is shown in Figure 25. The labels in Figure 25 refer 
to the labels used in the schematic diagrams which are shown in Appendix A. 

B. CALIBRATION 

Once the .MPU programs were capable of counting the pulses generated by the shaft 
encoders, the programs needed to be “calibrated". This calibration procedure required 
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Figure 22. Protot}pe/De\eIopmenf Model 
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Figure 23. Host Coniputer - Evaluation Module Connections 
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Figure 24. Monitor - Evaluation Module Connections 
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Figure 25. Evaluation Module - Signal Processor Connections 
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determining the angular distance through which the camera rotated between successive 
pulses from the shaft encoder. This number is a scale factor, which, when multiplied by 
the total number of pulses from the shaft encoder, yields a number equal to the angular 
displacement of the camera. The calibration procedure also involved determining the 
amount of hysteresis present in each of the gear trains. 

1. Scale Factor 

To determine the scale factor (SF) the simple geometric relationship 



was used. Using a small laser attached to the camera servo, and the geometry' shown in 
Figure 26, the SF could be experimentally determined. As the camera ser\’o was rotated 
through an angle, 6, the MPU was used to count the output pulses from the shaft en- 
coder. The laser beam was projected on a vertical surface at a distance, a, away from 
the axis of rotation. The beam of the laser spread to a diameter of approximately 0.4 
in. over a distance of 30 ft. A template with a 0.4 in. diameter aperture was used to mark 
the location of the “spots” on the distant wall. The distance between the spots, /, was 
measured by selecting one edge of one of the marks and measuring the distance to the 
corresponding edge of the distant mark. Then, having determined / and a and reading 
the count, C, from the display, the SF could then be determined from 




( 12 ) 



SF(degrees; Pulse) = 




(13) 



C 



Using Equation (13) to simphfy the expression, 




(14) 



yields 
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Figure 26. Geoinelry Used to Determine the Scale Factor 
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(15) 



which indicates that C, a and / should all be as large as possible to minimize the error 
in SF due to a measurement error in a or /. 1 he physical size of the laboratory limited 
the distance, a , to 30 ft. When a = 30 ft, / was limited to about 3.5 ft in the horizontal 
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plane and about 4.0 ft in the vertical plane. By modifying the geometry as shown in 
Figure 27, the count, which from Equation (13) is directly proportional to 6, could also 
be maximized. The configuration shown in Figure 27 was used to obtain the scale fac- 
tor calibration data for the Pan axis. However, since the servo is incapable of rotating 
360° about the Tilt axis, the test configuration shown in Figure 26 had to be used the 
collect the data for that axis. 




a 



Figure 27. Alternate Geometry Used to Determine the Scale Factor 

Adopting the notation, X, to represent the mean value of a random variable, 
X; if X is discrete with N measured values, 



X^ 



_L 

N 




/=! 



(16) 
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where A' is the /ih measured value of X, and the approximation becomes better as N 
approaches infinity. 

Using the expression in Equation (16) and the measured data for the scale fac- 
tors, from 31 measurements on the Pan axis, 

^Pan = (7-0312 X lO'YPulse"' , (17) 

and after 32 measurements on the Tilt axis, 

SEjiu = (7.0452 X 10~YPulse~’ , (18) 

where the subscripts indicate the axis. The actual implementation of these scale factors 
is described later in this chapter and in the documentation for each of the MPU pro- 
grams. 

If the error in the /th measurement is described by 

e,. = A)-X, (19) 

then the root mean square (RMS) error in X measurements of X is given by; 

N 

Ox= . (20) 

^ (=1 



Note that this is also the definition of the standard deviation of X. 

The R.VIS errors in the Pan and Tilt scale factor measurements were determined 
from Equation (20) and the measured data to be; 

asFp,„ = (-1.62x lO-^Pulse-' (21) 

asF,, = (6.S9x 10-VPulse-' . (22) 

As before, the subscripts are used to identify the axis and the source of the error. The 
fact that the errors are small compared to the mean values suggests that the means 
should closely approximate the actual values for the scale factors. 

2. Hysteresis 

Houghton defines backlash in wormgearing as “...the total play between the 
surfaces of the worm and worm wheel teeth measured normal to the faces.” [Ref 19; 
pp. 1.4, 1.5] Backlash only poses a problem in the measurement system when the servo's 
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direction of rotation changes. Figure 28 is a typical hysteresis curve. As long as the 
direction of rotation of the worm is increasing the (?worm/<^wormgear relationship is linear. 
However, when the direction of rotation reverses there is a region, depicted by the left 
pointing arrows, where the position of the worm changes without a corresponding 
change in the position of the wormgear. Note that once all of the backlash has been 
taken up the <?worm/^ wormgear relationship is again linear until the direction of rotation 
changes. 
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Figure 28. Typical Hysteresis Curve 



The purpose of the hysteresis buffer in the MPU is to permit the signal 
processor to account for the backlash error introduced into the measurement by tlie 
wonn-wormgear connection. The theorj' of operation for the buffer is relatively straigiit 
forward and is best described by the flow diagram in Figure 29. The buffer is a data 
byte in the MPU RAM. As long as the buffer is full, i.e., the contents are equal to the 
predetermined buffer length, a clockwise (CW) signal from the shaft encoder (increasing 
elevation and increasing azimuth are defined as CW rotation for the purposes of this 
system) causes the position counter to be incremented. Similarly, counter-clockwi<;e 
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Figure 29. Operation of the Hysteresis Buffer 
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Figure 30. Hysteresis Cune 



(CCW) signals cause the position counter to be decremented if the hysteresis buffer is 
empty, i.e., the contents are equal to zero. These two situations correspond to the two 
linear sections in Figure 28. From Equation (13), the horizontal separation of these two 
lines is related to the length of the hysteresis buffer, Ch by the expression 



r 

SF 



(23) 



Similarly, using the SF to map into C, and the fact that the displacement of the 

wormgear equals the displacement of the axis of interest, the curve shown in Figure 30 
can be obtained from Figure 28. From Figure 30 it is apparent that two different pulse 
counts can be obtained for any given position, 6 , depending on whether that position is 
approached from a CW or a CCW direction. The difference in the two counts is a 
measure of the hysteresis present in the gear train and is also the required length for the 
hysteresis buffer. By using this difference as the length of the hysteresis buffer, counts 
received by the VI PU which occur while the gears are operating on one of the horizontal 
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sections of the curve in Figure 30 are not considered “valid” and therefore do not cause 
the MPU to modify the position. Using Equation (23) and data collected in the labo- 
ratory the average hysteresis present in each of the gear trains was determined (from 45 
measurements on the Pan axis and 30 measurements on the Tilt axis) to be 



CH(Pan) = 7-39 Pulses 


(24) 


= 6.06 Pulses 


(25) 



and the RMS errors were calculated to be, 

Or =1.0 Pulses (26) 

''H(Pin) ' ' 

Or =0.91 Pulses. (27) 

C. IMPLEMENTATION OF THE CALIBRATION DATA 
I. Background 

Figure 31 outlines the basic operation of each of the MPU's. Although each 
of the routines is described in detail by the comments included in the programs, the op- 
eration of the Count Routine is the heart of the program and should be explained prior 
to discussing the actual implementation of the experimental results. 

When the system operator causes the camera servo to rotate, each optical shaft 
encoder translates the displacement of one of the axes into two series of digital pulses. 
The two pulse trains, referred to as Channels A and B, are TTL logic level signals. When 
the logic level of Channel A transitions from low to high (rising edge transition) or from 
high to low (falling edge transition), the edge detector (See Figure 15 on page 33) pulls 
pin 3 of the associated .MPU low for approximately 2 ^tsec. When this occurs an ex- 
ternal interrupt (EXT INT or INT ) request is generated and the .MPU begins execution 
of the Count Routine. 

As mentioned in Chapter 111, since both rising and falling edge transitions are 
detected by the edge detector, the signal processor must be capable of detecting multiple 
oscillations of the shaft about a single logic level transition point. Accordingly, the fu'st 
tasks performed by the Count Routine are to determine the direction of rotation and to 
simultaneously determine whether the interrupt is the result of a stationarv' shaft oscil- 
lation. To do this the Count Routine checks the state of pin 17 (Channel A) and pin 
19 (Channel B). Operation of this portion of the routine is summarized in Table 5. 
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V 



INITIALIZATION 

ROUTINE 



■< 




MODIFICATION 



ROUTINE 




Figure 31. Program Flow Diagram: Program executes in the Wait Loop until; (a) 

the operator requests to modify the hysteresis bulTer, (b) the operator 
requests to change the display mode, (c) an external interrupt is gener- 
ated by the Channel A edge detector or, (d) a timer interrupt causes the 
display mode to “blink”. All interrupt routines are terminated with a 
return from interrupt (R'l'l) command. 



61 



I 



Note that CW rotation is indicated when Channel B leads Channel A in phase and CCW 
rotation is indicated if Channel A is leading Channel B. The possibility of erroneously 
counting multiple oscillations about a single point is eliminated by “counting” only the 
leading edge transitions when the shaft is rotating CW and only the trailing edge tran- 
sitions when the rotation is CCW. All other transitions cause the program to execute 
a “return from interrupt” (RTI) instruction. 

2. Implementing the Hysteresis Buffer 

The transitions that are to be counted cause the program to compare the con- 
tents of the hysteresis buffer, HYSTCT, and the direction of rotation to the exper- 
imentally determined buffer length, HYSTs^Ch . If the rotation is CW and the buffer is 
full (i.e., HYSTCT = HYST), or if the rotation is CCW and the buffer is empty (i.e., 
HYSTCT = 0), then the “slack” due to the gear backlash should have been taken up , 
the transitions are considered “valid” and the MPU modifies the position appropriately. 
“Invalid" counts cause the contents of the hysteresis buffer to be incremented or decre- 
mented depending on whether the present direction of rotation is CW or CCW 
(Figure 29 refers). 



Table 5. COUNT ROUTINE LOGIC 



Channel A 


Channel B 


Direction 
of Rotation 


Count the 
Pulse? 


Action 


Low 


Low 


CW 


No 


Increment the 
hysteresis buffer. 


Low 


High 


CCW 


Yes 


Decrement 
the position. 


High 


Low 


CCW 


No 


Decrement the 
hysteresis buffer. 


High 


High 


CW 


Yes 


Increment 
the position. 



From the calibration data for the Pan axis, Ch(p,„)=^ 7.4 and c^ch(p,„^— I-^- Because 
the length of the hysteresis buffer must be an integer value, CH,p,n), needed to be rounded 
off Rounding to the nearest whole number initially seemed the most logical approach. 
Upon further consideration, however, it was decided to round 7.4 up to 8. Considering 
the relatively small data base (45 measurements) upon which the average was based, the 
fact that the standard deviation was 1.0 and that the gear backlash will only increase 
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with time, this seemed like the most reasonable approach. The bufTer length for the Tilt 
axis was set equal to 6 (€„(!«,) = 6.06) . 

3. Implementing the Scale Factor 

There are three counters in each MPU that keep track of the position informa- 
tion for the axis of interest. The first, BINCT, is simply a binary counter that is incre- 
mented by one for each valid CW count and decremented by one for each valid CCW 
count. The other two counters consist of two sets of pointers, two sets of data registers 
and a shared data table. Each byte in a pointer points to an address in the table that 
contains two BCD digits which make up a portion of the position information. 

In order to increment (decrement) the pulse count, BCDCT, by one, the count 
pointer, CTPTR, is incremented (decremented) by one causing it to point to a new table 
address. The contents of the table at the new addresses are then moved into BCDCT. 
Modification of the position counter, DEGRES, is performed in much the same manner. 
DEGRES contains a BCD number that, when multiplied by 0.001, represents the angu- 
lar position (in degrees) of the shaft of interest. Thus, each time the camera is displaced 
in a CW direction through one degree, the contents of DEGRES should be incremented 
by 1000. To do this, the position pointer, PTR, must be incremented (decremented) by 
seven or eight each time CTPTR is incremented (decremented) by one. Incrementing 
PTR by seven corresponds to an angular displacement of 0.007° and since 
SFp,„ and SEt,,, are each slightly larger than 0.007°, periodically PTR must be incre- 
mented by eight to reduce the cumulative round off error. Specifically, if PTR is incre- 
mented by seven each time a valid CW pulse is detected (except when BINCT is an even 
multiple of 32) and is incremented by eight when BINCT is a modulo 32 number, the 
effective scale factor is given by; 

=-^(31(0.007) + 0.008) 

= 0.00703 125°Pulse“’ , 

which is slightly larger than the desired 0.00703 12°Pulse'', for the Pan axis and slightly 
smaller than the desired 0.0070452°Pulse'' for the Tilt axis. To further reduce the cu- 
mulative round off on the Pan axis, every 16,384 (2'^ = 32 x 512) counts PTR is incre- 
mented by seven instead of eight. This results in an effective scale factor of, 
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( 29 ) 



= -jjj jsi 1 [ -^ (3 1(7) + 8) X 10-^ j + O.OO?! 

= (7.031 19 X 10"^)“Pulse"’ , 

which is within two parts in one million. 

The maximum error introduced into the measurement should occur when the 
camera is rotated through the largest possible angle. To predict this error on the Pan 
axis, when the camera has been displaced by 360°, 



BCDCT 



360' 



SF 



Pan 



= 51,200 Pulses 



(30) 



so the position error using SF.^^j and SF,^,^ should be; 

epan = 360' - [3(SF,^^; + (51,200 - 3(16,384))(S,^^;] 

= 0.00295' . 

Thus, the error due to the scale factor on the Pan axis should be well within the desired 
resolution of ± 0.006' . 

Using Sf, j alone as the scale factor for the Tilt a.xis, the maximum theoretical 
error over ±12' due to the scale factor round off is determined in the same manner. 



1 ■>' 

BCDCT = ^#— 

SFtiit 

= 17,033 Pulses 



(32) 



So that. 



eTil.= 12”-n.033(SF«,,) 

= 0.0234” , ' ’ 

which again is significantly less than the required resolution of ±0.23' for the Tilt axis. 

The final step in the Count Routine is a branch to the Display Routine. De- 
pending on whether the MPU is in the Count or Position Mode, the Display Routine 
copies the contents of BCDCT or DEGRES to the output ports and then executes an 
RTl instruction. 
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D. FINAL TESTING 
1. General 

Final laborator>' testing and evaluation of the measurement system was per- 
formed after the calibration results had been implemented in each of the MPU Count 
Routines. The purpose of the testing was to verify that the calibration results had been 
properly coded into the MPU's and to determine the resolution capabilities of the 
measurement system experimentally. 

This verification process included determining the combined error due to the 
hysteresis and scale factor errors. The use of some simple multiple random variable 
theoiy was therefore required. From [Ref 20: pp. 121,122] the variance of a weighted 
sum of M random variables is the weighted sum of their covariances, and is given 

by, 



M M 

= . (34) 

1=1 y=i 

where a, is the weight associated with X,. Additionally, the covariance can be expressed 
as 



CxY = P<7 x<^Y 



(35) 



where p is the normalized second-order moment and is known as the correlation coefli- 
cient ofX and V. The correlation coefficient is bounded by 

-1 < P < 1 . (36) 

In the case where there are two equally weighted random variables, .M = 2 and 
a, = o.j= 1.0. Substituting into Equation (34) and expanding 

(7^ = Cxx + CxY + Gyx + Cyy • (37) 

Using Equation (35), 

= a\ + IpOx^Y + oy • (38) 



Combining (36) and (38) yields 



2 

(7X- 



2 ctx < 7 y <^y ^ < 



(39) 
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The bounds of the combined scale factor and hysteresis errors can therefore be deter- 
mined from 



V 



/ 2 









\ 



<^esp + + <^eH 



(40) 



where: 

• a, = standard deviation of the combined error, 

• = standard deviation of the scale factor error, and 

• = standard deviation of the hysteresis error. 



Note that the bounds are determined by the two cases where the hysteresis error, and 
the scale factor error, e^F, are “completely correlated”. The upper bound corresponds 
to the case where an increase in e^p implies an increase in e„, and the lower bound cor- 
responds to the case where an increase in Cjp directly implies a decrease in en- 

A third case is also of particular interest. If and Cjp are completely uncor- 
related. i.e., p = 0, then from Equation (38), 



n 7 ~ 

<=’e = \ 



(41) 



which can also be written as 

^ = i \^^sF > 



(42) 



where c = + a, is the 1.0 g error due to the scale factor and hysteresis errors, e^p and en 
respectively. Based on the physical nature of the two errors it is reasonable to assume 
that ejp and Cp, are statistically uncorrelated; however, no experimental data was collected 
to support this hypothesis. Due to this lack of a priori information, the ma.ximum R.MS 
error. e„,, = ± given by 

^max = ± V ^SF + ^espCn + epi , (43) 

will be used to describe the resolution capabilities of the measurement system. 

2. Pan Axis 

a. Hysteresis 

To test the operation of the Pan axis hysteresis buffer, the Initialization 
Routine was programmed to set the buffer length to 8. Then, as described in the first 
section of this chapter, the servo was used to position the beam of a small laser on a 
fixed target. By approaching the target alternately from a QW and a CCW direction and 
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comparing the difierence in the output counts from the shaft encoders, the hysteresis 
error was determined. The average error after 31 measurements was 

^H(Pan) = “0.1880 Pulses , (44) 

and the RMS error was 

Oe = 1.7699 Pulses . (45) 

Since the mean error is “near zero” compared to the standard deviation, the 1.0 o error 
Oh, due to the hysteresis can be determined from 

ew = ±K)^ (46) 

so that 

eH(Pan) = + 0.0124' . (47) 



b. Scale Factor 

Verification of the scale factor was performed in the same manner as the 
scale factor calibration, except that the MPU was calibrated in the Count Mode and 
tested in the Position Mode. Since these tests sought to find the maximum error due to 
the scale factor, and the error is directly proportional to the angle that is being meas- 
ured, these tests were conducted by displacing the camera servo through the maximum 
angles permitted by the camera and the laborator>'. Specifically, on the Pan axis the 
servo was rotated through approximately 360°. The mean error due to the scale factor 
on the Pan axis was determined from 15 samples to be 

Wan) = -0.0018° (48) 



and the RMS error was 



a 



^SFtPan) 



0.00890° . 



(49) 



As with the hysteresis error, if we neglect the small bias due to the esF(P,n) , can de- 
scribe the 1.0 a RMS error due to the scale factor as 

esF(Pan) = ± <^SF(Pan) 

= ±0.00890° ■ ^ ’ 
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c. Combined Error 



From Equation (42) the combined error on the Pan axis if Ch and Cjp are 
uncorrelated can be estimated as 



ep^ = + 7(00124)^ + (0.0089)^ 
= ±0.01526* . 



(51) 



And from Equation (43) the maximum combined error on the Pan axis is 

'P'n... = ± \ (0.0 1 24)^ + 2(0.0 1 24X0.0089) + (0.0089)^ (52) 



• ( 53 ) 



The combined error is approximately three times larger than the design specification 
limit and is due primarily to the hysteresis error. 

3. Tilt Axis 

a. Hysteresis 

The procedure used to verify the operation of the calibrated Tilt MPU was 
identical to that described in the previous section. Using a hysteresis bufier length of 6 
resulted in 



^H(Tiit) = -0.0965 Pulses 



(54) 



and, 



a, = 1.3156 Pulses (55) 

after 13 samples. As before we can define the 1.0 a error from e = oSF to be 

eH„,, = ± 0.00529* . (56) 



b. Scale Factor 

Testing the scale factor on the Tilt axis was limited by the physical con- 
struction of the servo and the size of the laborator}'. The angle over which testing could 
be performed was limited to ±6* from the horizontal plane. Consequently, the RMS 
error for the scale factor on the Tilt axis was determined in exactly the same manner as 
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the RMS error for the Pan axis scale factor, but since the error due to rounding of the 
scale factor is directly proportional to the angle being measured the results were multi- 
plied by 2.0 to account for the limited range of the test. The modified results should 
therefore be representative of the maximum error one should expect if the measurement 
system is used to measure elevation angles over a range of + 12° . 

The error due to the scale factor is described from 16 samples by 

^SF(Tiit) ~ 0.0070° (57) 



and, 



^SF(Tilt) 



= 0.0665° 



Including the factor of two in the calculation we have 

^sF(Tiit) ~ i 2(0.0665°) 
= ±0.1330° . 



(58) 



(59) 



c. Combined Error 

The combined RMS error is determined in the same manner as before. If 
eH and e^p are uncorrelated, 



ejiit = ± v' (0.1330)' + (0.00529)" 
= 0.1331° , 



(60) 



and the maximum combined RMS error is 



= ± ^/(0.1330)‘ ± 2(0.1330)(0.00529) ± (0.00529)^ (61) 



eT.u„„ = +0.1383° . (62) 



The Tilt axis measurement system appears to perform well within the required resolution 
specifications. 
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E. FINAL IMPLEMENTATION 

Once the program debugging, calibration and testing were completed, final imple- 
mentation of the system remained. Taking the design from the prototype, 'development 
model to a fully functional system was a straightforw'ard but time-consuming evolution. 

The plans for the printed circuit boards (PCB's) were made directly from the sche- 
matics shown in Appendix A; the boards were then etched and assembled from the plans 
which are shown in Appendix B. All of this work was performed by sailors attached to 
the Academic Division of the NPS. 

As previously discussed, the M68705EVM Evaluation Module provided a powerful 
and flexible means of debugging and evaluating the performance of the microprocessor 
based signal conditioner. Additionally, once program testing was completed the EVM's 
EPROM microprocessor programmer provided the means to program the EPROM 
MCU's. A detailed, but simple to follow, programming procedure for programming the 
MC6S705U3 is given in [Ref 18; pp. (3-26)-(3-27)]. 
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V. CONCLUSIONS AND RECOMMENDATIONS 



A. SYSTEM PERFORMANCE 

The prototype system was calibrated and successfully tested in a laboratory environ- 
ment. Experimental results indicate that the system is capable of measuring the video 
camera's elevation over a range of ±12° with a resolution of ±0.138° and its azimuth 
over 360° with a resolution of ±0.021°. The system was designed to be low’ cost, reliable, 
and easy to operate. Only time w’ill tell whether these objectives were truly achieved. 

The portion of the system that will be located outdoors has been w’eatherproofed 
and is ready to be placed in service. Printed circuit board plans for the remainder of the 
system have been developed, but final implementation of the system is still ongoing. 
Once the system is fully operation additional testing should be performed in order to 
verify the completed system's performance. Although the laborator>’ results indicate 
that the system is capable of meeting all of the design criteria except for the required 
resolution on the Pan axis, the system must be further tested in a non-laborator>' envi- 
ronment. “...The proof of a good design rests in the ability of the system to function in 
the outside world." [Ref 21] 

B. RECOMMENDATIONS FOR FURTHER WORK 

There are several areas for follow-on work with this project. Some possibilities are: 

• Incorporate the measurement system's output into the video image being created 
by the video camera. This would permit a permanent record of the position infor- 
mation to be stored with the video image and would facilitate identification of the 
image at a later date. 

• Design and build an automatic feedback control system for the camera. 

• Implementation of a second video camera at the NPS, together with the XPS 
modified IRSTD, would permit triangulation of a target and would consequently 
provide range information which is not currently available. This information could 
provide valuable additional information to those who are developing the signal 
processing algorithms. 
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APPENDIX A. SCHEMATIC DIAGRAMS 
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APPENDIX B. PRINTED CIRCUIT BOARD PLANS 
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Line Driver, (a) Front and (b) Back. Full scale. 
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Pan MPU, Proiu. 90 % of full scale. 
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Pan MPU, Back. 90 % of full scale. 
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Tilt MPU, Front. 85 % of full scale. 
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Tilt MPU, Back. 85 % of full scale. 
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HI MUS D5 




Display, Front. Full scale. 
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Display, Back. Full scale. 
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APPENDIX C. MICROPROCESSOR PROGRAMS 



A. GENERAL 

Sections B and C of this Appendix are the hsting files for the two MPU programs 
written for the signal processor subsystems. The theory of operation of the two pro- 
grams is identical and is most clearly described by Figure 31, The detailed operation 
of the Initialization , Mode Change, Blink, Output Display and Hysteresis Modify rou- 
tines is described by the comments which accompany each of the programs. In addition 
to the detailed description provided by the program comments, the operation of the 
Count Routine is also explained in Chapter IV. 
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B. PAN 



1 






TTL 




POSITION DETERMINING PROGRAM (AZIMUTH) 


2 




* 






LATEST REVISION 9 MAY 89 


3 




* 






FILE NAME PAN. ASH 


4 




** 








5 




** PROGRAM DESCRIPTION 




6 




** 








7 




** 








8 




** 








9 




** I/O REGISTER ADDRESSES 


10 












11 


0000 


PORTA 


EOU 


soooo 


I/O PORT A 


12 


0001 


PORTS 


EOU 


80001 


I/O PORT 8 


13 


0002 


PORTC 


EOU 


80002 


I/O PORT C 


14 


0003 


PORTD 


EOU 


80003 


INPUT PORT D 


15 




** 








16 




** DATA DIRECTION REGISTER OFFSET 


17 












18 


0004 


DDR 


EOU 


4 


(eg. DOR FOR PORT A IS PORTA^-DDR ) 


19 




** 








20 




** OTHERS 






21 




** 








22 


0008 


TIMER 


EOU 


80008 


EIGHT BIT TIMER REGISTER. 


23 


0009 


TCR 


EOU 


80009 


TIMER CONTROL REGISTER. 


24 


OOOA 


MR 


EOU 


8000A 


MISCELLANEOUS REGISTER. 


25 


0010 


RAM 


EOU 


80010 


START OF ON-CHIP RAH(112 - 31 FOR STACK) 


26 


0080 


ZROM 


EOU 


80080 


PAGE ZERO OF ROM. 


27 


0100 


ROM 


EOU 


80100 


START OF MAIN ROM. 


28 


0F38 


MOR 


EOU 


80F38 


MASK OPTION REGISTER. 


29 


0FF8 


INTRPT 


EOU 


80FF8 


LOCATION OF INTERRUPT VECTORS. 


30 


1000 


MEMSIZ 


EOU 


81000 


MEMORY ADDRESS SIZE. 


31 




** 








32 




** EQUATES 






33 




** 








34 


0001 


BITO 


EOU 


1 




35 


0002 


BIT1 


EOU 


2 




36 


0004 


BIT2 


EOU 


4 




37 


0008 


BIT3 


EOU 


8 




38 


0010 


BIT4 


EOU 


16 




39 


0020 


BIT5 


EOU 


32 




40 


0040 


BIT6 


EOU 


64 




41 


0080 


BIT7 


EOU 


128 




42 




** 








43 


0000 


BO 


EOU 


0 




44 


0001 


B1 


EOU 


1 




45 


0002 


B2 


EOU 


2 




46 


0003 


B3 


EOU 


3 




47 


0004 


B4 


EOU 


4 




48 


0005 


B5 


EOU 


5 




49 


0006 


B6 


EOU 


6 




50 


0007 


B7 


EOU 


7 




51 




** 








52 




•* EQUATES FOR 


THE TIMER CONTROL REGISTER 


53 




** 








54 




*** 








55 


0007 


TIR 


EOU 


7 


TIMER INTERRUPT REQUEST. 1 = REQUEST, 0 = NO REO. 


56 


0006 


TIM 


EOU 


6 


TIMER INTERRUPT MASK. 1 = DISABLED, 0 = ENABLED. 


57 


0005 


TIN 


EOU 


5 


EXTERNAL OR INTERNAL CLOCK SOURCE. 1 = EXT, 0 = INI 


58 


0004 


TEE 


EOU 


4 


EXTERNAL CLOCK ENABLE. NOT USED. 


59 


0003 


PSC 


EOU 


3 


PRESCALER CLEAR. NOT USED. 


60 


0002 


PS2 


EOU 


2 


(PS2) -- 


61 


0001 


PS1 


EOU 


1 


(PSD I-- PRESCALER SELECT BITS. 
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62 

63 

6A 

65 

66 

67 

68 

69 

70 

71 

72 

73 

74 

75 

76 

77 

78 

79 

80 

81 

82 

83 

84 

85 

86 

87 

88 

89 

90 

91 

92 

93 

94 

95 

96 

97 

98 

99 

100 

101 

102 

103 

104 

105 

106 

107 

108 

109 

110 

111 

112 

113 

114 

115 

116 

117 

118 

119 

120 

121 

122 

123 

124 

125 

126 

127 



0000 PSO EOU 0 (PSO) -- 

** EQUATES FOR THE STATUS BYTE, 'STAT'. 
*** 



** 



0007 


UD 


EQU 


7 


(MUNT DIRECTION? 1 = UP, 0 * DOWN. 


0006 


M00_32 


EOU 


6 


IS 'BINCT' MODULO 32? 1 * YES, 0 * NO. 


0005 


FLASH 


EQU 


5 


BLINK THE DISPLAY? 1 « YES, 0 * NO. 


0004 


POSCT 


EQU 


4 


DISPLAY POSITION OR (»JNT? 1 « POS, 0 < COUNT. 


0003 


L_SET 


EQU 


3 


VALUE OF 'MOOE,PORTD' UST TIME. 


0002 


NEGTIV 


EQU 


2 


IS 'BCDCT'NEGATIVE NUMBER? 1 > YES, 0 » NO. 




*** 




1 


NOT USED. 




*** 




0 


NOT USED. 



itiHt 



0007 

0006 

0004 



PORT A (I/O) 



+ -■ 
I 






BCD 


DIGIT 


#4 




I 




BCD DIGIT 


#3 




j 


D4 


I 


C4 


I 


B4 j 


A4 


I 


D3 


i ” ! 


B3 i 


A3 


BIT 


7 




6 




5 


4 




3 


2 


1 


0 



PORT B (I/O) 



** I/O EQUATES AND DESCRIPTIONS. 

*** 

*** 

*** 

*** 

*** 

*** 

*** 

*** 

*** 

*** 

*** 

*** -+ + + +- 

*** 

*** 

*** 

*** + +- 

*** BIT 7 

DECPT EOU 7 

POST IV EOU 6 

*** 

BLANK EQU 4 

*** 

*** 

*** 

*** 

*** 






-+ + 



|BCD DIGIT #5 (HOST SIGNIFICANT)! 



I DISPLAY CONTROL * 

f - + + + + + + + 

I DECPT I POSTIVj I BLANK j D5 j C5 j B5 j A5 j 



1 



TO DISPLAY THE DECIMAL POINT. . .DECPT IS CLEARED 
USED TO DISPLAY NEGATIVE SIGN. . .CLEARED TO SHOW 
MINUS SIGN. 

TO BLANK DIGITS 2 AND 3... CLEAR BLANK. 

DIGITS 4 AND 5 ARE ALWAYS BLANKED. 

DIGIT 1 IS NEVER BLANKED. 



PORT C (I/O) 



*** 

... 1 
*** 4... 




BCD 


DIGIT 


#2 




|BCD DIGIT 


(LEAST 


SIGNIFICANT) 


*** 1 
*** 4... 


D2 1 


C2 


1 


B2 j 


A2 


1 D1 I 


C1 I 


B1 I A1 


♦** bit 


7 


6 




5 


4 


3 


2 


1 0 



*** 

*** 

*** 

*** 

*** 



PORT 0 (INPUT ONLY) 



I CH_A I INT2 I CH_B | FUNCT | SET | 







4 — 












*** BIT 




7 


6 5 4 3 


2 1 


0 




*** 












0007 


CH_A 


EOU 


7 


INDICATES THE STATUS OF 


CHANNEL A. 




0006 


INT2 


EOU 


6 


INTERRUPT #2. USED TO 1 


CHANGE DISPLAY 


MODES. 


0005 


CH_.B 


EOU 


5 


INDICATES THE STATUS OF 


CHANNEL B. 




0004 


FuiicT 


EOU 


4 


USED TO PUT THE PROGRAM 


IN A MODE THAT 


WILL ALLOW 
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128 






*** 






'HYST' TO BE INCREMENTED. 


129 




0003 


SET 


EOU 


3 


INCREMENTS 'HYST' WHEN TOGGLED AND FUNCT IS LOU. 


130 






*** 








131 














132 








133 






** 








134 






** 






RAM VARIABLES * 


135 






** 






★ 


136 








137 






** 








138 






** RESERVE MEMORY SPACE 


FOR THE PkCXiRAM VARIABLES. 


139 














140 


0000 






DATA 






141 






** 








142 






** 








143 


0000 






ABSOLUTE (ABSOLUTE ADDRESSING USED HERE TO RELATIVE DIRECTIVE) 


144 






** 








145 


0010 






ORG 


RAM 


START OF RAM. 


146 






** 








147 






*** BINARY COUNT. 




148 


0010 




BINCT 


RMB 


3 




149 




0010 


HIBIN 


EOU 


BINCT 


HI BYTE. 


150 




0011 


HIDBIN 


EOU 


BINCT+1 


MIDDLE BYTE. 


151 




0012 


L06IN 


EOU 


BINCT+2 


LO BYTE. 


152 






** 








153 






*** POSITION POINTERS. 




154 


0013 




PTR 


RHB 


4 


EACH BYTE POINTS TO A POSITION IN THE 


155 






** 






TABLE THAT CONTAINS ONE OR TWO DIGITS 


156 






** 






OF THE BCD POSITION. 


157 




0013 


PTR4 


EOU 


PTR 


MOST SIGNIFICANT DIGITS. 


158 




0014 


PTR3 


EOU 


PTR+1 




159 




0015 


PTR2 


EOU 


PTR+2 




160 




0016 


PTR1 


EOU 


PTR+3 


LEAST SIGNIFICANT DIGIT. 


161 






*• 








162 






*** COUNT POINTERS. 




163 


0017 




CTPTR 


RHB 


3 


EACH BYTE POINTS TO A POSITION IN THE 


164 






** 






TABLE THAT CONTAINS TWO OF THE DIGITS 


165 






** 






IN THE BCD COUNT. 


166 




0017 


CTPTR3 


EOU 


CTPTR 


MOST SIGNIFICANT DIGITS. 


167 




0018 


CTPTR2 


EOU 


CTPTR-^1 




168 




0019 


CTPTR1 


EOU 


CTPTR+2 


LEAST SIGNIFICANT DIGITS. 


169 






** 








170 






*** BCD 


POSITION IN DEGREES. 


171 


001A 




DEGRES 


RHB 


4 




172 




001A 


HUNDEG 


EOU 


DEGRES 


CONTENTS X 100.000 


173 




001B 


ONEDEG 


EOU 


DEGRES-^1 


CONTENTS X 1.000 


174 




001 C 


HUNDTH 


EOU 


DEGRES-^2 


CONTENTS X 0.010 


175 




001D 


THOUTH 


EOU 


DEGRES+3 


+ CONTENTS X 0.001 


176 






*** 








177 






*** 






POSITION IN DEGREES 


178 






** 








179 






*** BCD 


COUNT. 






180 


001E 




BCDCT 


RHB 


3 




181 




001E 


TENTHO 


EOU 


BCDCT 


CONTENTS X 10,000 


182 




001 F 


HUNDRD 


EOU 


BCDCT-^1 


CONTENTS X 100 


183 




0020 


TENONE 


EOU 


BCOCT-^2 


+ CONTENTS X 1 


184 






*** 








185 






*** 






NUMBER OF PULSES COUNTED 


186 






*** 








187 






•** HYSTERESIS 


COUNTER. 


POINTS TO A NUMBER IN THE TABLE THAT IS THE 


188 






*** 


AMOUNT 


OF HYSTERESIS PRESENT IN THE SYSTEM. INITIALIZED TO 7. 


189 


0021 




HYSTPT 


RHB 


1 




190 






** 








191 






*** POSITION INCREMENT. 


CONTAINS A NUMBER, THAT WHEN MULTIPLIED BY 0.001 


192 






*** 


IS THE 


NUMBER OF DEGREES THAT THE POSITION COUNTER (BCDPOS) IS 


193 






*** 


TO BE 


INCREMENTED OR DECREMENTED DURING PROGRAM EXECUTION. 
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194 






*** 


THE VALUE OF 'POSINC', DETERMINED EXPERIMENTALLY, SHOULD BE 


195 






*** 


7.0312. SINCE THE PROGRAM IS DESIGNED WORK WITH INTEGERS ONLY 


196 






*** 


THIS NUMBER IS ROUNDED TO 7. TO REDUCE THE CUMULATIVE EFFECT OF 


197 






*** 


THE ROUND OFF, EVERY 32 COUNTS 'POSINC' IS SET EOUAL TO 8. THIS 


198 






*** 


AGAIN LEADS TO SOME CUMULATIVE ERROR THAT IS ACCOUNTED FOR BY 


199 






*** 


SETTING 'POSINC' TO 7 INSTEAD OF 8 WHEN THE COUNT REACHES A 


200 






*** 


VALUE OF 16384 (2*14). 


201 






*** 




202 


0022 




POSING 


RMB 1 


203 






*** 




204 






••• HYSTERESIS VARIABLES. USED TO ELIMINATE THE EFFECTS OF BACKLASH ON 


205 






*** 


THE POSITION MEASUREMENTS. 


206 










207 


0023 




HYST 


RMB 1 THE THRESHHOLD VALUE DETERMINED 


208 






*** 


EXPERIMENTALLY. 


209 


0024 




HYSTCT 


RMB 1 CURRENT AMOUNT OF HYSTERESIS MEASURED. 


210 






*** 




211 






*** STATUS BYTE. USED TO KEEP TRACK OF WHAT IS GOING ON. 


212 






*** 




213 


0025 




STAY 


RMB 1 CURRENT STATUS. 


214 


0026 




LSTAT 


RMB 1 PREVIOUS/LAST STATUS. USED TO KEEP TRACK OF 


215 






*** 


L SET ONLY. 


216 






*** 




217 






*** TIMER COUNTER. USED IN CONJUNCTION WITH THE TIMER PRESCALER AND THE 


218 






*** 


TDR TO KEEP TRACK OF ONE SEC. INTERVALS. USED IN BLINKING THE 


219 






*** 


DISPLAY. INITIALLY SET TO 31, WHEN THE 'FLASH' BIT OF 'STAT' 


220 








IS SET. TIMCT IS DECREMENTED EACH CLOCK INTERRUPT (APPROX. 31 


221 






*** 


TIMES PER SEC). RESET TO 31 WHEN CONTENTS GO TO ZERO. 


222 






*** 


WHEN (TIMCT)=0 THE DISPLAY WILL TOGGLE. 


223 






*** 




224 


0027 




TIMCT 


RMB 1 


225 






** 




226 








ENDS 


227 






** 




228 






*** 




229 






************************************************************************ 


230 






** 


* 


231 






** 


PAGE ZERO ROM 


232 






** 


* 


233 






************************************************************************ 


234 






** 




235 






** 


INITIALIZATION ROUTINE. 


236 






** 




237 






** 




238 


0000 






CODE 


239 






** 




240 


0080 






ORG ZROM PAGE ZERO ROM. 


241 






** 




242 


0080 






RELATIVE RELATIVE ADDRESSING MUST BE USED FOR THE BRANCH. 


243 






** 




244 




0080 


RESTRT 


EOU $ THIS IS THE ENTRY POINT WHEN THE RESET 


245 






*** 


SWITCH IS PUSHED. 


246 






** 




247 










248 






** 




249 






*** 


INITIALIZE THE PC AND CLEAR RAM. 


250 






*** 




251 






*** 




252 


0080 


9B 




SEI SET INTERUPT TO AVOID INTERUPTION AND 


253 


0081 


9C 




RSP RESET THE STACK POINTER. JUST IN CASE! 


254 






*** 




255 


0082 


AE 10 




LDX #6INCT CLEAR ALL OF THE VARIABLES BETWEEN 


256 


0084 


7F 


CLRIT 


CLR ,X 'BINCT' AND 'TIMCT' ( INCLUSIVE) .NOTE 


257 


0085 


5C 




INCX THAT THIS SETS THE COUNTER AND THE POS* 


258 


0086 


A3 27 




CPX #TIMCT ITION TO ZERO. THIS MEANS THAT ROTATION 


259 


0088 


23 FA 




BLS CLRIT SHOULD START IN AN INCREASING (CW) 
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260 

261 

262 

263 

264 

265 

266 

267 

268 

269 

270 

271 

272 

273 

274 

275 

276 

277 

278 

279 

280 

281 

282 

283 

284 

285 

286 

287 

288 

289 

290 

291 

292 

293 

294 

295 

296 

297 

298 

299 

300 

301 

302 

303 

304 

305 

306 

307 

308 

309 

310 

311 

312 

313 

314 

315 

316 

317 

318 

319 

320 

321 

322 

323 

324 

325 



008A 



008A 

008C 

008E 

0090 



0092 



0095 

0097 

0099 

009B 



0090 

009F 

00A1 



00A3 



00A5 



00A7 

00A9 



OOAB 

OOAD 



OOAF 



*** 

*** 



A6 FF 


*** 

*** 

*** 

*** 


LDA 


#-1 


B7 04 




STA 


PORTA+OOR 


B7 05 




STA 


PORTB^DDR 


B7 06 




STA 


PORTC-K)OR 


CD 03 4E 


*** 

*** 


JSR 


OUTCT 



A6 08 




LDA 


#XO(X)01000 


B4 03 




AND 


PORTD 


B7 25 


*** 


STA 


STAT 


1C 25 




BSET 


MOO_32,STAT 



A6 08 
B7 23 
B7 21 



A6 47 



B7 09 



A6 FF 
B7 08 



A6 IF 
B7 27 



DIRECTION FROM THE I40ST CCU POSITION 
AFTER A RESET. 

ABSOLUTE BACK TO ABSOLUTE ADDRESSING. 



ESTABLISH I/O PORTS. 

PORTS A,B,C ARE CONFIGURED AS 
ALL OUTPUT. PORT D IS ALL INPUT 
SO THERE IS NO MASK TO SET. 



COUNT IS TO EE DISPUTED INITIALLY. 
SET UP THE STATUS REGISTER. 

> SET UP 'L SET' BIT OF 'STAT'. 



*** 



************************************************************************ 

*** 

*** 

*** 



INITIALIZE HYSTCT. 



SET UP THE TIMER FOR A 4 MHZ CRYSTAL / 4 = 1 MHZ CLOCK. 

NOTE: THE MASK OPTION REGISTER IS IN ROM. IT IS SET UP AT 

THE END OF THE PROGRAM. 



ID OA 



LDA #08 

STA HYST 

STA HYSTPT 

*** 

** 

*** 

*** 

*** 

********************* ggj jjp TCR- ♦♦***♦★♦♦♦♦♦♦♦♦♦♦♦♦♦♦♦♦♦♦♦♦♦♦**♦ 
*** 

LDA #BIT6+BIT2+BIT1+BIT0 

*** (TIM)|(PS2)(PS1)(PS0) 

♦♦♦(DISABLE INTERRUPT)! (PRESCALE BY 128) 

*** 

STA TCR 

*** 

*** 

♦♦♦ SET UP THE TIMER. 

*** 

LDA #255 1 MHZ/( 128^255) = 30.6 (APPROX. 31) 

STA TIMER 

*** 

**************** initialize the timer COUNTER. ♦**♦♦********♦♦♦***♦**♦ 
*** 

LDA #31 PROVIDES FOR 1 SEC. BLINK INTERVAL. 

STA TIMCT FOR 2 SEC. INTERVAL JUST USE TIMECT=62, etc. 

*** 

*** 

********************************************************************** 

** 

♦♦ SET UP MISCELLANEOUS REGISTER. 

** 

BCLR B6,MR ENABLES THE SECOND INTERRUPT. 
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326 






** 










327 






** 










328 


00B1 


9A 




CLI 


CLEAR THE 


INTERRUPT MASK TO GET 


STARTED. 


329 






*** 










330 


OOB2 






RELATIVE RELATIVE ADDRESSING MUST BE USED FOR THE 


331 






*** 




REMAINOER 


OF THE PROGRAM. 




332 






*** 










333 






************************************************************************ 


334 






** 










335 






** WAIT 


LOOP. 


EXECUTES, UNTIL AN 


INTERRUPT OCCURS. 




336 






** 










337 


00B2 


09 03 OB 


PAUSE 


BRCLR 


FUNCT, PORTO, CHHYST 


WANT TO CHANGE HYST? 




338 






** 






YES... GO TO CHHYST. 




339 


00B5 


06 03 04 




BRSET 


SET, PORTO, SBIT 


NO... 'SET, PORTO' SET? 




340 


00B8 


17 25 




8CLR 


L^SET,STAT 


MO... CLEAR »L SET, STAY' 


341 


OOBA 


20 F6 




BRA 


PAUSE 


ANO LOOP. 




342 


ODBC 


16 25 


SBIT 


BSET 


L SET,STAT 


YES... SET 'L SET, 


,STAT' 


343 


OOBE 


20 F2 




BRA 


PAUSE 


AND... LOOP 




3U 






** 










345 








346 






** 










347 






** HYSTERESIS 


MODIFICATION ROUTINE 


. PERMITS MODIFICATION OF THE 


348 






** HYSTERESIS 


BUFFER WITHOUT REPROGRAMMING. 




349 






** 










350 


OOCO 


A6 40 


CHHYST 


LOA 


#BIT6 


DISABLE TIMER INTERRUPT. 


351 


00C2 


B7 09 




STA 


TCR 






352 






*** 










353 


OOC4 


A6 08 




LOA 


nooooiooo 


SAVE 'L SET' 




354 


00C6 


B4 25 




ANO 


STAT 


INTO 




355 


00C8 


B7 26 




STA 


LSTAT 


'LSTAT'. 




356 


OOCA 


A6 08 




LOA 


#X00001000 






357 


oocc 


B4 03 




ANO 


PORTO 


'SET.PORTD' --> ACCUMULATOR 


358 


OOCE 


B1 26 




CMP 


LSTAT 


HAS THE SET SWITCH BEEN CHANGED? 


359 


0000 


27 15 




BEG 


OISPLA 






360 






*** 






YES... 




361 


0002 


A6 08 




LOA 


nooooiooo 


-- 




362 


0004 


B8 25 




EOR 


STAT 


|-->CHANGE 'L SET, STAT', 


363 


0006 


B7 25 




STA 


STAT 


-- 




364 


0008 


3C 23 




INC 


HYST 


THEN INCREMENT THE HYSTERESIS 


365 


OOOA 


3C 21 




INC 


HYSTPT 


POINTER AND 'HYST'... 




366 






*** 










367 


OOOC 


B6 21 




LOA 


HYSTPT 


-- 




368 


OODE 


A1 19 




CMP 


#25 






369 


OOEO 


23 05 




BLS 


OISPLA 


-- 




370 






*** 






-- BUT NOT ABOVE 25. 


371 


00E2 


4F 




CLRA 




THEN---> 




372 


00E3 


B7 23 




STA 


HYST 






373 


00E5 


B7 21 




STA 


HYSTPT 


- . 




374 






*** 










375 


00E7 


A6 00 


OISPLA 


LOA 


#xoooooooo 


NO... JUST > 




376 


00E9 


B7 00 




STA 


PORTA 






377 


OOEB 


A6 CO 




LOA 


#X1 1000000 






378 


OOEO 


B7 01 




STA 


PORTB 


\ 


/ 


379 






*** 






-- DISPLAY CURRENT 'HYST'. 


380 


OOEF 


BE 21 




LOX 


HYSTPT 


-- 




381 


00F1 


06 03 BE 




LOA 


TABLE, X 






382 


00F4 


B7 02 




STA 


PORTC 


-- 




383 






*** 






IS ‘HYST' SETTING COMPLETE? 


384 


00F6 


09 03 C7 




BRCLR 


FUNCT, PORTO, CHHYST 


NO... KEEP CHECKING ' 


SET'. 


385 


00F9 


08 25 05 




BRSET 


POSCT, ST AT, SHOPOS 


YES... RESET THE DISPLAY. 


386 


OOFC 


CO 03 4E 




JSR 


OUTCT 






387 


OOFF 


20 03 




BRA 


DUNCHG 






388 






*** 










389 


0101 


CO 03 68 


SHOPOS 


JSR 


OUTPOS 






390 






*** 










391 


0104 


OB 25 04 


DUNCHG 


BRCLR 


FLASH, STAT, NO_I NT 


IF THE DISPLAY IS TO 


BLINK... 



93 



392 

393 

394 

395 

396 

397 

398 

399 

400 

401 

402 

403 

404 

405 

406 

407 

408 

409 

410 

411 

412 

413 

414 

415 

416 

417 

418 

419 

420 

421 

422 

423 

424 

425 

426 

427 

428 

429 

430 

431 

432 

433 

434 

435 

436 

437 

438 

439 

440 

441 

442 

443 

444 

445 

446 

447 

448 

449 

450 

451 

452 

453 

454 

455 

456 

457 



0107 


A6 


07 


LDA 


#8IT2^BIT1+BIT0 


ENABLE TIMER INTERRUPT AND RESET 


0109 


B7 


09 


STA 


TCR 


TIMER PRESCALER 


01 OB 


20 


A5 


NO I NT BRA 


PAUSE 


PRIOR TO RETURNING. 



** 

*************^**«^«^***#********«**#« *♦♦*****«-* ************************* 

** KAXIMUM EXECUTION TIME FOR THE REMAINDER OF THE PROGRAM OCCURS 
** IF THE COUNTER ROTATES THROUGH ZERO AS THE DISPLAY MODE IS CHANGED 
** FROM THE BLINKING MODE TO THE COUNT NODE AT THE SAME TIME THAT THE 
** BLINKING ROUTINE IS CAUSING THE DISPUY TO TOGGLE TO SHOU THE 
♦* POSITION IN DEGREES. 

♦♦ MAXIMUM EXECUTION TIME » 140 ♦ 184 ♦ 708 * 1032 CLOCK CYCLES. 



** NODE CHANGE ROUTINE. CHANGES THE DISPUY MODE FROM 

** COUNT -> POSITION -> BLINKING -> COUNT -> (ETC.) 

MAXIMUM EXECUTION TIME OF 181 CLOCK CYCLES OCCURS WHEN THE 
DISPLAY NODE IS CHANGED FROM DISPLAYING THE COUNT TO DISPLAYING 
THE POSITION (IN DEGREES). 

IF THE DISPUY IS CHANGED FROM BLINKING TO A COUNT DISPLAY 
EXECUTION TIME IS 140 CLOCK CYCLES. 



** 

** 



0100 


IF 


OA 




CHNOOE 


BCLR 


B7,MR 


AVOID REPEATED INTERRUPTS. 


010F 


OA 


25 


10 




BRSET 


FLASH, STAT, DIS CT 


IF FLASHING, DISPLAY COUNT... 


0112 


09 


25 


07 




BRCLR 


POSCT, ST AT, DISPOS 


IF SHOWING COUNT, DISPLAY POSITION... 


0115 


1A 


25 




** 


BSET 


FLASH, STAT 


ELSE, BLINK. 


0117 


A6 


07 






LDA 


#8IT2+BIT1+BIT0 


ENABLE TIMER INTERRUPT AND RESET 


0119 


B7 


09 






STA 


TCR 


TIMER PRESCALER. 


011B 


80 








RTI 






011C 


18 


25 




DISPOS 


BSET 


POSCT, STAT 




011E 


CO 


03 


68 




JSR 


OUTPOS 1 


DISPLAY CURRENT POSITION, AND WAIT 


0121 


80 






** 


RTI 






0122 


A6 


47 




0IS_CT 


LDA 


#BIT6+BIT2-)’BIT1+BIT0 DISABLE TIMER INTERRUPT AND RESET 


0124 


B7 


09 






STA 


TCR 


TIMER PRESCALER. 


0126 


19 


25 






BCLR 


POSCT, STAT 




0128 


IB 


25 




** 


BCLR 


FLASH, STAT 


-- DISPLAY CURRENT COUNT, AND WAIT. 


01 2A 


CD 


03 


4E 




JSR 


OUTCT 




012D 


80 








RTI 


-- 





*********************** ******************^*^*^**^*^*^************************* 



** BLINK ROUTINE. INTERRUPT ROUTINE TO CHANGE THE DISPLAY FROM POSITION 
** TO COUNT OR VICE VERSA EVERY 31 ST TIMER INTERRUPT IF THE 

** 'FLASH' BIT OF 'STAT' IS SET. 

MAXIMUM EXECUTION TIME OF 184 CLOCK CYCLES OCCURS WHEN THE 
** DISPLAY IS TOGGLED FROM A COUNT DISPLAY TO A POSITION DISPLAY. 





01 2E 


BLINK 


EOU 


S 






012E 


OF 09 DC 




BRCLR 


TIR,TCR,CHMOOE 


IF THE INTERRUPT WAS 


NOT A TIMER 






** 

** 






INTERRUPT IT MUST BE 


FROM INT2. 


0131 


IF 09 


** 


BCLR 


TIR,TCR 


AVOID REPEATED TIMER 


INTERRUPTS. 


0133 


3A 27 


DEC 


TIMCT 


IF THERE HAVE BEEN 31 


TIMER 


0135 


27 01 


** 


BEO 


CHGDIS 


INTERRUPTS (1 SEC), 
CHANGE THE DISPLAY. 


IT'S TIME TO 


0137 


80 


** 


RTI 




OTHERWISE, IT'S BACK 


TO WORK. 


0138 


A6 IF 


CHGDIS 


LDA 


#31 


RESET TIMCT TO 31 (1 


SEC. INTERVAL) 


013A 


B7 27 




STA 


TIMCT 







94 



013C 

013E 

0140 

0142 

0145 

0148 

0149 

014C 

014D 

0150 

0151 

0153 

0155 

0157 

0159 

015B 

01 50 

015F 

0162 

0164 

0166 

0168 



86 25 
A8 10 

87 25 

08 25 



CO 03 
80 



CO 03 
80 



0140 
OA 03 
80 



A6 7F 
84 25 
87 25 
A6 80 
84 03 

8A 25 
87 25 



OE 25 

86 24 
27 60 

AO 01 

87 24 



04 



4E 





LOA 


STAT 










EOR 


«%000 10000 |- 


- CHANGE 


'POSCT' BIT 


OF 'STAT'. 




STA 


STAT 








** 


BRSET 


POSCT, ST AT, POSOUT 


DECIDE 


ON CORRECT 


DISPLAY. 














************ 


CHANGE THE DISPLAY TO 


SHOW THE 


COUNT 


♦★******♦****** 


** 


JSR 


OUTCT 









RTI 



♦♦**♦****♦♦* OR HAVE THE 01 SPLAY SHOW THE POSITION. *♦***♦♦♦****♦*♦*** 

68 POSOUT JSR OUTPOS 

RTI 



COUNT ROUTINE. 

WHEN A COUNT IS RECEIVEO THIS IS THE ENTRY POINT . 

MAXIMUM EXECUTION TIME OF 708 CLOCK CYCLES OCCURS WHEN THE 
COUNTER ROTATES CCW THROUGH ZERO ANO THE POSITION (IN OEGREES) 
IS BEING OISPLAYEO. 



** CURRENT OIRECTION OF ROTATION IS OETERMINEO BY INSPECTING THE STATUS 
** OF 'CH_A' ANO 'CH,B'. THE FOUR POSSIBILITIES ANO THE ASSOCIATEO 
** OIRECTION OF ROTATION ARE AS SHOWN BELOW. NOTE THAT THIS SCHEME 
** PREVENTS MULTIPLE OSCILLATIONS ABOUT A SINGLE POINT FROM 

** REPEATEOLY INCREMENTING OR OECREMENTING THE COUNTER. 

** 



** 1 
** 1 


1 CH_A 1 

1 j 


1 CH B 

1 


1 DIRECTION 1 

1 OF ROTATION | 


1 COUNT THE PULSE? | 
[ 1 




LO 


LO 


1 cw 


NO 


** 


LO 


HI 


1 CCW 


YES 


** 


HI 


LO 


1 CCW 


NO 


** 


HI 


HI 


1 CW 


YES 



** + + + + — + 



01 



** 

COUNT 






^ FIRST SEE IF WE ARE SUPPOSEO TO COUNT THIS INTERUPT. *♦*★***★ 
EQU S 

BRSET CH_^B, PORTO, OKCT IF CH_B IS LO WE OON'T COUNT THE 
RTI “ INTERRUPT. 



************** IF THE INTERRUPT IS VALIO UPOATE 'STAT'. ************** 
** 



OKCT LOA 
ANO 
STA 
LOA 
ANO 

* 

ORA 

STA 



#%01111111 

STAT 

STAT 

#X1 0000000 
PORTO 

STAT 

STAT 



SAVE ALL OF THE OLO 'STAT' EXCEPT THE 
OIRECTION OF ROTATION. 

'CH^A, PORTO' INOICATES THE OIRECTION 
OF ROTATION ANO BECOMES 'UD,STAT'. 

ADD THE RESULTS TO GET 
THE NEW 'STAT'. 



** DECIDE IF THE “SLACK** DUE TO BACKLASH/HYSTERESIS HAS BEEN TAKEN OUT. 



09 




BRSET 


UD,STAT,HYSTCK 


IF ROTATING CW SEE BELOW. 






LOA 


HYSTCT 


ELSE, SEE IF WE DECREMENT THIS TIME. 






BEQ 


CCW 


IF HYSTCT=0, GO TO THE COUNT DOWN 




** 






ROUTINE. 






SUB 


#1 


ELSE, DECREMENT THE HYSTERESIS COUNTER, 






STA 


HYSTCT 





95 



524 


016A 


80 




RTI 




AND WAIT FOR THE NEXT INTERRUPT. 


525 






** 








526 


0168 


86 23 


HYSTCK 


LDA 


HYST 


IF ROTATING CW 


527 


0160 


81 24 




CMP 


HYSTCT 


AND HYST * HYSTCT 


528 


016F 


27 03 




BEQ 


CU 


COUNT THE PULSE . 


529 


0171 


3C 24 




INC 


HYSTCT 


ELSE, INCREMENT THE HYSTERESIS COUNTER, 


530 


0173 


80 




RTI 




AND WAIT FOR ANOTHER PULSE. 


531 






** 








532 






** 








533 














534 






itit 








535 






** 




CLOCICUISE ROUTINE. 


536 






Hit 








537 




0174 


cu 


EQU 


% 




538 






** 








539 














540 








INCREMENT THE 


BINARY COUNTER (BINCT). ♦♦**♦** **^*^*** 


541 














542 


0174 


86 12 




LDA 


LOGIN BEGIN 


AT THE LSB OF THE BINARY COUNTER. 


543 


0176 


A8 01 




ADD 


#1 LOGIN 


= LOGIN ♦ 1 ; CARRY -> C,CCR 


544 


0178 


87 12 




STA 


LOGIN 




545 






*** 








546 


01 7A 


86 11 




LDA 


HIDBIN 




547 


01 7C 


A9 00 




ADC 


#0 


ADD THE CARRY TO THE MIDDLE BYTE. 


548 


017E 


87 11 




STA 


HIDBIN 




549 






*** 








550 


0180 


86 10 




LDA 


HIBIN 




551 


0182 


A9 00 




ADC 


#0 


ADD THE CARRY TO THE HIGH BYTE. 


552 


0184 


87 10 




STA 


HIBIN 




553 






*** 








554 






*** 








555 






••••••••••••••*•** CLR/SET MOO 32 APPROPRIATELY. ********************* 


556 






unit 








557 






*** 


THE FOLLOWING SEVERAL 


LINES OF CODE ARE PRETTY MESSY. ALL THAT 


558 






*** 


IS BEING DONE IS TO ENSURE THAT THE SCALE FACTOR IS SET PROPERLY. 


559 






*** 


FOR THE 


PAN AXIS THE 


SCALE FACTOR IS; 


560 






*** 








561 










1 PULSE => 0.007097 DEGREES 


562 






*** 








563 


0186 


86 12 




LDA 


LOBIN 


IF THE LOU FIVE BITS OF 'LOBIN' ARE NOT 


564 


0188 


A4 IF 




AND 


noooiiiii 


ZERO THEN THE NUMBER ISN'T A HOOULO 32 NUMBER. 


565 


018A 


26 OF 




BNE 


NOT 32 




566 


018C 


86 11 




LDA 


HIDBIN 


IF THE LOU SIX BITS OF 'HIDBIN' ARE ZERO 


567 


018E 


27 07 




BEQ 


HOO 


AND 'HIBIN' .NE. ZERO 


568 


0190 


A4 3F 




AND 


#X00111111 


THEN THE NUMBER IS MODULO 16,384, AND WE 


569 


0192 


26 03 




BNE 


HOO 


DON'T WANT TO SET 'MOO 32,STAT', UNLESS 


570 


0194 


00 11 04 




BRCLR 


86, HIDBIN, NOT 


_32 THE NUMBER IS ALSO MODULO 32,768. 


571 






*** 








572 


0197 


1C 25 


MOO 


BSET 


MOO_32,STAT 




573 


0199 


20 02 




BRA 


DIRCHK 




574 






*** 








575 


019B 


ID 25 


NOT_32 


BCLR 


MOO_32,STAT 




576 














577 














578 


0190 


86 10 


DIRCHK 


LDA 


HIBIN 




579 


019F 


28 ID 




BHI 


CWNEG 


IF HIBIN < 0 , WE'RE ROTATING CCW TOWARD 


580 






*** 






THE ORIGIN. 


581 






*** 








582 


01A1 


26 14 




BNE 


CWPOS 




583 


01A3 


86 11 




LDA 


HIDBIN 


ELSE IF BINCT .NE. 0 


584 


01A5 


26 10 




BNE 


CWPOS 


WE'RE ROTATING CW 


585 


01A7 


86 12 




LDA 


LOBIN 


AWAY FROM THE ORIGIN. 


586 


01 A9 


26 OC 




BNE 


CWPOS 




587 














588 






*** 






ELSE, WE'VE ROTATED CW THROUGH THE ORIGIN. 


589 


01AB 


15 25 




BCLR 


NEGTIV,STAT 


CLR NEGATIVE SIGN. 



96 



590 

591 

592 

593 

594 

595 

596 

597 

598 

599 

600 

601 

602 

603 

604 

605 

606 

607 

608 

609 

610 

611 

612 

613 

614 

615 

616 

617 

618 

619 

620 

621 

622 

623 

624 

625 

626 

627 

628 

629 

630 

631 

632 

633 

634 

635 

636 

637 

638 

639 

640 

641 

642 

643 

644 

645 

646 

647 

648 

649 

650 

651 

652 

653 

654 

655 



01AD 


AE 13 




LDX 


#PTR4 


OlAF 


7F 


CLRIT2 


CLR 


,x 


01B0 


5C 




INCX 




01B1 


A3 1D 




CPX 


#THOUTH 


01 B3 


23 FA 




BLS 


CLRIT2 


01B5 


20 66 


*** 


BRA 


UPOUT 


01B7 


AD 74 


CWPOS 


BSR 


AODBCO 


01 B9 


CO 02 6A 




JSR 


INCPOS 


01BC 


20 64 




BRA 


UPOUT 


01BE 


CO 02 CA 


CUNEG 


JSR 


SU6BC0 


01C1 


CO 02 6A 




JSR 


INCPOS 


01C4 


20 5C 




BRA 


UPOUT 



*** 



--RESET ALL COUNTERS AND DEGRES TO ZERO. 
UPDATE OUTPUT. 



COUNTER-CLOCICWISE ROUTINE. 



01C6 CCW EOU $ 

*** 

****************** CLR/SET MOD_32 APPROPRIATELY. ********************* 



*** 



AGAIN SET THE SCALE FACTOR TO; 



*** 

*** 



1 PULSE => 0.007097 DEGREES 



01C6 


66 


12 




LDA 


L06IN 


IF THE LOW FIVE BITS OF 'LOBIN' ARE NOT 


01C8 


A4 


IF 




AND 


#X00011111 


ZERO THEN THE NUMBER ISN'T A MODULO 32 NUMBER 


01CA 


26 


OF 




BNE 


NO 32 




01CC 


B6 


11 




LDA 


HIDBIN 


IF THE LOU SIX BITS OF 'MIDBIN' ARE ZERO 


01CE 


27 


07 




BEO 


MODLO 


AND 'HIBIN' .NE. ZERO 


01D0 


A4 


3F 




AND 


#X00111111 


THEd THE NUMBER IS MODULO 16,384, AND UE 


01D2 


26 


03 




BNE 


MOOLO 


DON'T WANT TO SET 'MOD 32,STAT', UNLESS 


01D4 


00 


11 04 


*** 


BRCLR 


B6, MIDBIN, NO. 


.32 THE NUMBER IS ALSO~MOOULO 32,768. 


01D7 


1C 


25 


MOOLO 


BSET 


M00..32,STAT 




01 D9 


20 


02 


*** 


BRA 


DECBIN 




01DB 


ID 


25 


NO_32 


BCLR 


M00.,32,STAT 





*** 



*************** decrement THE BINARY COUNTER (BINCT). **************** 
*** 



01DD 


B6 12 


DECBIN 


LDA 


LOBIN 


BEGIN AT THE LSB OF THE BINARY COUNTER. 


OlDF 


AO 01 




SUB 


#1 


LOBIN = LOBIN - 1 ; BORROW -> C,CCR 


01E1 


B7 12 


*** 


STA 


LOBIN 




01E3 


B6 11 




LDA 


MIDBIN 




01E5 


A2 00 




SBC 


#0 


SUBTRACT THE CARRY FROM THE MIDDLE BYTE. 


01E7 


B7 11 


*** 


STA 


MIDBIN 




01E9 


B6 10 




LDA 


HIBIN 




01EB 


A2 00 




SBC 


#0 


SUBTRACT THE CARRY FROM THE HIGH BYTE. 


DIED 


B7 10 


*** 


STA 


HIBIN 




01EF 


B6 10 




LDA 


HIBIN 




01F1 


2A 29 


*** 


BPL 


CCWPOS 


IF HIBIN .GE. 0 , WE'RE ROTATING CCW TOWARD 
THE ORIGIN. 


01F3 


A6 FF 




LDA 


#-1 


-- 


01 F5 


B1 10 




CMP 


HIBIN 


-- 


01F7 


26 1C 




BNE 


CCWNEG 


-- ELSE IF BINCT .NE. -1 , 


01 F9 


B1 11 




CMP 


MIDBIN 


-- WE'RE ROTATING CCW AWAY 


01FB 


26 18 




BNE 


CCWNEG 


-- FROM THE ORIGIN. 



97 



656 

657 

658 

659 

660 

661 

662 

663 

664 

665 

666 

667 

668 

669 

670 

671 

672 

673 

674 

675 

676 

677 

678 

679 

680 

681 

682 

683 

684 

685 

686 

687 

688 

689 

690 

691 

692 

693 

694 

695 

696 

697 

698 

699 

700 

701 

702 

703 

704 

705 

706 

707 

708 

709 

710 

711 

712 

713 

714 

715 

716 

717 

718 

719 

720 

721 



01FD 


B1 


12 




CHP 


LOeiN 


01FF 


26 


14 


*** 


BNE 


CCWNEG -- 


0201 


14 


25 




BSET 


NEGTIV,STAT ELSE, UE'VE GONE THROUGH ORIGIN IN CCW 








*** 




DIRECTION. SET NEGATIVE SIGN. 








*** 




AND SET ALL COUNTERS APPROPRIATELY. 


0203 


A6 


03 




LDA 


#03 


0205 


B7 


13 




STA 


PTR4 


0207 


B7 


1A 




STA 


HUNDEG -- DEGRES ^ 360.00 


0209 


A6 


3C 




LDA 


#60 


020B 


B7 


14 




STA 


PTR3 


0200 


AE 


15 




LDX 


#PTR2 -- 


020 F 


7F 




CLREM 


CLR 


.X 


0210 


5C 






INCX 


— EVERYTHING ELSE IS ZERO BEFORE CHANGE. 


0211 


A3 


19 




CPX 


KCTPTRI 


0213 


23 


FA 


*** 


BLS 


CLREM 


0215 


AD 


16 


CCUNEG 


BSR 


AOOBCO 


0217 


CO 


02 FD 




JSR 


DECPOS 


021A 


20 


06 




BRA 


UPOUT 


021C 


CD 


02 CA 


CCWPOS 


JSR 


SUBBCO 


021F 


CO 


02 FD 


*** 


JSR 


DECPOS 








*** 












** 




















** 












** OUTPUT ROUTINE. ROUTINE TO PRINT DATA TO THE OUTPUT PORTS. BY 








** 


CALLING THE APPROPRIATE SUBROUTINE. ( 'OUT CT ' TO OUTPUT THE 








** 


THE 


COUNT AND 'OUTPOS' TO OUTPUT THE POSITION). 








** 








0222 


UPOUT 


EQU 


$ 








** 






0222 


09 


25 04 


** 


BRCLR 


POSCT,STAT, PUTCT 


0225 


CD 


03 68 




JSR 


OUTPOS 


0228 


80 




** 


RTI 




0229 


CO 


03 4E 


PUTCT 


JSR 


OUTCT 


022C 


80 




** 


RTI 










*********** 


SUBROUTINE TO INCREMENT THE BCD COUNTER (BCDCT). ********* 








*** 






022D 


B6 


19 


ADDBCD 


LDA 


CTPTR1 


022F 


AB 


01 




ADD 


#1 


0231 


A1 


63 




CMP 


#99 CTPTR > 99 ? 


0233 


23 


05 




BLS 


OKI NO, WE'RE OK HERE. LOOK UP THE FIRST TWO DIGITS. 


0235 


AO 


64 




SUB 


#100 YES... MODIFY THE CTPTR, 


0237 


99 






SEC 


SET THE CARRY, AND 


0238 


20 


01 


*** 


BRA 


OK1A USE TABLE LOOK UP. 


023A 


98 




OKI 


CLC 


NO CARRY EXISTS IF WE ENTER AT THIS POINT 


023B 


B7 


19 


OK1A 


STA 


CTPTR1 


023D 


97 






TAX 










*** 




-- LOOK UP THE TWO LEAST SIGNIFICANT DIGITS. 


023E 


D6 


03 BE 




LDA 


TABLE, X 


0241 


B7 


20 




STA 


TENONE -- 


0243 


24 


24 


*** 


BCC 


NOMO AND CONTINUE ONLY IF THERE WAS A CARRY. 








*** 






0245 


B6 


18 




LDA 


CTPTR2 


0247 


A9 


00 




ADC 


#0 ADD THE CARRY. 


0249 


A1 


63 




CMP 


#99 CTPTR > 99 ? 


024B 


23 


05 




BLS 


OK2 NO, WE'RE OK HERE. LOOK UP THE NEXT TWO DIGITS. 



98 



722 

723 

724 

725 

726 

727 

728 

729 

730 

731 

732 

733 

734 

735 

736 

737 

738 

739 

740 

741 

742 

743 

744 

745 

746 

747 

748 

749 

750 

751 

752 

753 

754 

755 

756 

757 

758 

759 

760 

761 

762 

763 

764 

765 

766 

767 

768 

769 

770 

771 

772 

773 

774 

775 

776 

777 

778 

779 

780 

781 

782 

783 

784 

785 

786 

787 



0240 


AO 64 






SU6 


#100 


YES... MODIFY THE CTPTR, 


024F 


99 






SEC 




SET THE CARRY, AND 


0250 


20 01 






6RA 


0K2A 


USE TABLE LOOK UP. 


0252 


98 




0K2 


CLC 




NO CARRY EXISTS IF WE ENTER AT THIS POINT. 


0253 


67 18 




0K2A 


STA 


CTPTR2 


-- 


0255 


97 






TAX 




-- 








*** 






-- LOOK UP THE NEXT TWO DIGITS IN THE TABLE. 


0256 


D6 03 


66 




LOA 


TABLE, X 


-- 


0259 


67 IF 






STA 


HUMDRO 


-- 


025B 


24 OC 




*** 


6CC 


NOMO 


AND CONTINUE ONLY IF THERE WAS A CARRY. 


0250 


B6 17 






LOA 


CTPTR3 




025F 


A9 00 






ADC 


#0 


ADD THE CARRY. 


0261 


67 17 






STA 


CTPTR3 


-- 


0263 


97 






TAX 




-- 








*** 






-- LOOK UP THE NEXT TWO DIGITS IN THE TABLE. 


0264 


06 03 


6E 




LOA 


TABLE, X 


-- 


0267 


87 IE 






STA 


TENTHO 


• • 


0269 


81 




NOMO 


RTS 


























************************************************************************ 












INCREMENT THE POSITION COUNTER (DEGRES). ******* 








*** 














**** 


FIRST CHECK TO SEE IF THE BINARY COUNTER HAS REACHED A MODULO 32 








**** 


NUMBER 












**** 








026A 


00 25 


04 


INCPOS 6RCLR 


MOO 32, 


STAT.INC7 »MOO_32,STAT' SET ? 








**** 








0260 


A6 08 






LOA 


#8 


YES ... 


026F 


20 02 




**** 


BRA 


INC 


INCREMENT THE POSITION BY 0.008 DEGREES. 


0271 


A6 07 




INC7 


LOA 


#7 


NO 


0273 


67 22 




INC 


STA 


POSINC 


INCREMENT THE POSITION BY 0.007 DEGREES. 








**** 














«*** 


ROUTINE TO 


INCREMENT THE POSITION COUNTER , 'DEGREES' , BY A 








**** 


PREDETERMINED , 


AMOUNT, 'POSINC'. 








**** 








0275 


66 16 






LOA 


PTRI 




0277 


66 22 






ADD 


POSINC 




0279 


A1 09 






CMP 


#9 


PTRI > 9 ? 


027B 


23 05 






BLS 


0X3 


NO, WE'RE OX HERE. LOOX UP THE FIRST DIGIT. 


0270 


AO OA 






SUB 


#10 


YES... MODIFY THE CTPTR, 


027F 


99 






SEC 




SET THE CARRY, AND 


0280 


20 01 




**** 


BRA 


OX3A 


USE TABLE LOOX UP. 


0282 


98 




0<3 


CLC 




NO CARRY EXISTS IF WE ENTER AT THIS POINT. 


0283 


67 16 




0»3A 


STA 


PTRI 


-- 


0285 


97 






TAX 




-- 








**** 






-- LOOX UP THE LEAST SIGNIFICANT DIGIT. 


0286 


06 03 


6E 




LDA 


TABLE, X 




0289 


67 10 






STA 


THOUTH 




0286 


24 3C 






BCC 


DONE 


AND CONTINUE ONLY IF THERE WAS A CARRY. 








**** 








0280 


66 15 






LOA 


PTR2 




028F 


A9 00 






ADC 


#0 


ADD THE CARRY. 


0291 


A1 63 






CMP 


#99 


PTR2 > 99 ? 


0293 


23 05 






BLS 


0X4 


NO, WE'RE OX HERE. LOOX UP THE NEXT TWO DIGITS. 


0295 


AO 64 






SUB 


#100 


YES. ..MODIFY THE CTPTR, 


0297 


99 






SEC 




SET THE CARRY, 


0298 


20 01 




**** 


BRA 


OX4A 


AND USE TABLE LOOX UP. 


029A 


98 




(X4 


CLC 




NO CARRY EXISTS IF WE ENTER AT THIS POINT. 


0296 


67 15 




CX4A 


STA 


PTR2 


-- 



99 



788 


0290 


97 






TAX 




789 








**** 






790 


029E 


06 


03 BE 




LDA 


TABLE, X 


791 


02A1 


B7 


1C 




STA 


HUNDTH 


792 


02A3 


24 


24 




BCC 


DONE 


793 














794 














795 


02A5 


B6 


14 




LDA 


PTR3 


796 


02A7 


A9 


00 




ADC 


m 


797 


02A9 


A1 


63 




CMP 


#99 


798 


02AB 


23 


05 




BLS 


OKS 


799 


02AD 


AO 


64 




SUB 


#100 


800 


02AF 


99 






SEC 




801 


02B0 


20 


01 




BRA 


0K5A 


802 








**** 






803 


02B2 


98 




0K5 


CLC 




804 


02B3 


B7 


14 


0K5A 


STA 


PTR3 


805 


02B5 


97 






TAX 




806 








«*** 






807 


02B6 


06 


03 BE 




LDA 


TABLE, X 


808 


02B9 


B7 


IB 




STA 


ONEDEG 


809 


02BB 


24 


OC 




BCC 


DONE 


810 














811 


02BO 


B6 


13 




LDA 


PTR4 


812 


02BF 


A9 


00 




ADC 


#0 


813 


02C1 


B7 


13 




STA 


PTR4 


814 


02C3 


97 






TAX 




815 














816 


02C4 


D6 


03 BE 




LDA 


TABLE, X 


817 


02C7 


B7 


1A 




STA 


HUNDEG 


818 








**** 






819 


02C9 


81 




DONE 


RTS 




820 








*** 






821 














822 










823 










* SUBROUTINE TO 


824 














825 


02CA 


B6 


19 


SUBBCD 


LDA 


CTPTRI 


826 


02CC 


AO 


01 




SUB 


#1 


827 


02CE 


24 


03 




BCC 


0K6 


828 


0200 


AB 


64 




ADD 


#100 


829 


0202 


99 






SEC 




830 








♦♦♦ 






831 


0203 


B7 


19 


0K6 


STA 


CTPTRI 


832 


02D5 


97 






TAX 




833 














834 


02D6 


D6 


03 BE 




LDA 


TABLE, X 


835 


02D9 


B7 


20 




STA 


TENONE 


836 


02DB 


24 


IF 




BCC 


COMPLT 


837 














838 








*** 






839 


020D 


B6 


18 




LDA 


CTPTR2 


840 


020 F 


A2 


00 




SBC 


#0 


841 


02E1 


24 


03 




BCC 


0K7 


842 


02E3 


AB 


64 




ADD 


#100 


843 


02E5 


99 






SEC 




844 








*** 






845 


02E6 


B7 


18 


0K7 


STA 


CTPTR2 


846 


02E8 


97 






TAX 




847 














848 


02E9 


D6 


03 BE 




LDA 


TABLE, X 


849 


02EC 


B7 


IF 




STA 


HUNDRD 


850 


02EE 


24 


OC 




BCC 


COMPLT 


851 














852 


02F0 


B6 


17 




LDA 


CTPTR3 


853 


02F2 


A2 


00 




SBC 


#0 



-- LOCK UP THE NEXT TWO DIGITS IN THE TABLE. 



AND CONTINUE ONLY IF THERE WAS A CARRY. 



ADO THE CARRY. 

PTR3 > 99 ? 

NO, WE'RE OIC HERE. LOCK UP THE NEXT TWO DIGITS. 
YES... MODIFY THE CTPTR, 

SET THE CARRY, AND 
USE TABLE LOOK UP. 

MO CARRY EXISTS IF WE ENTER AT THIS POINT. 



-- LOOK UP THE NEXT TWO DIGITS IN THE TABLE. 



AND CONTINUE ONLY IF THERE WAS A CARRY. 



ADD THE CARRY. 



-- LOOK UP THE NEXT TWO DIGITS IN THE TABLE. 



DECREMENT THE BCD COUNTER (BCDCT). ♦****♦♦♦**** 



CTPTR > 99 ? 

NO, WE'RE OK HERE. LOOK UP THE FIRST TWO DIGITS. 
YES, MODIFY THE CTPTR, AND 
GENERATE A BORROW. 



•• LOOK UP THE TWO LEAST SIGNIFICANT DIGITS. 



AND CONTINUE ONLY IF THERE WAS A BORROW. 



SUBTRACT THE CARRY. CTPTR > 99 ? 

NO, WE'RE OK HERE. LOOK UP THE NEXT TWO DIGITS. 
YES, MODIFY THE CTPTR, AND 
GENERATE A BORROW. 



-- LOOK UP THE NEXT TWO DIGITS IN THE TABLE. 



AND CONTINUE ONLY IF THERE WAS A CARRY. 



SUBTRACT THE BORROW. 



100 



854 

855 

856 

857 

858 

859 

860 

861 

862 

863 

864 

865 

866 

867 

868 

869 

870 

871 

872 

873 

874 

875 

876 

877 

878 

879 

880 

881 

882 

883 

884 

885 

886 

887 

888 

889 

890 

891 

892 

893 

894 

895 

896 

897 

898 

899 

900 

901 

902 

903 

904 

905 

906 

907 

908 

909 

910 

911 

912 

913 

914 

915 

916 

917 

918 

919 



02F4 


B7 


17 






STA 


CTPTR3 -- 


02F6 


97 








TAX 


- - 










*** 




-- LOOK UP THE NEXT TWO DIGITS IN THE TABLE 


02F7 


D6 


03 


BE 




LDA 


TABLE, X -- 


02 FA 


B7 


IE 




*** 


STA 


TENTHO -- 


02FC 


81 






COMPLT 


RTS 












*** 














*************«***************«******«******«***********«-****-************ 












• SUBROUTINE TO DECREMENT THE POSITION COUNTER (DEGRES). ******* 










*** 
















FIRST CHECK TO SEE IF THE BINARY COUNTER HAS REACHED A MODULO 32 












NUMBER 


, 
















02F0 


DO 


25 


04 


DECPOS 


BRCLR 


M00_32,STAT,DEC7 'MOO_32,STAT' SET 7 
















0300 


A6 


08 






LOA 


«8 YES... 


0302 


20 


02 




**** 


BRA 


DEC DECREMENT THE POSITION BY 0.008 DEGREES. 


0304 


A6 


07 




DEC7 


LOA 


#7 NO 


0306 


B7 


22 




OEC 


STA 


POSINC DECREMENT THE POSITION BY 0.007 DEGREES. 










**** 














*••• ROUTINE TO DECREMENT THE F>0SIT10N COUNTER .'DEGREES', BY A 










**** 


PREOETERMINEO AMOUNT, 'POSING'. 
















0308 


B6 


16 






LOA 


PTR1 


030A 


BO 


22 






SUB 


POSINC PTR1 <07 


030C 


24 


03 






BCC 


OKS NO. WE'RE OK HERE. LOOK UP THE FIRST DIGIT. 


030E 


AB 


OA 






ADO 


#10 YES, MODIFY THE CTPTR, AND 


0310 


99 






**** 


SEC 


GENERATE A BORROW. 


0311 


B7 


16 




0K8 


STA 


PTR1 


0313 


97 








TAX 


-- 










**** 




-- LOOK UP THE LEAST SIGNIFICANT DIGIT. 


0314 


06 


03 BE 




LOA 


TABLE, X -- 


0317 


B7 


10 






STA 


THOUTH -- 


0319 


24 


32 




*** 


BCC 


OUNSUB AND CONTINUE ONLY IF THERE WAS A BORROW. 










*** 






031B 


B6 


15 






LDA 


PTR2 


031D 


A2 


00 






SBC 


#0 SUBTRACT THE BORROW. PTR2 < 0 ? 


031 F 


24 


03 






BCC 


OK9 NO, WE'RE OK HERE. LOOK UP THE NEXT TWO DIGITS. 


0321 


AB 


64 






ADD 


#100 YES, MODIFY THE CTPTR, AND 


0323 


99 






*** 


SEC 


GENERATE A BORROW. 


0324 


B7 


15 




0K9 


STA 


PTR2 


0326 


97 








TAX 


-- 










*** 




-- LOOK UP THE NEXT TWO DIGITS IN THE TABLE. 


0327 


06 


03 


BE 




LDA 


TABLE, X -- 


032A 


B7 


1C 






STA 


HUNDTH -- 


032C 


24 


IF 




*** 


BCC 


OUNSUB AND CONTINUE ONLY IF THERE WAS A CARRY. 










*** 






032E 


B6 


14 






LOA 


PTR3 


0330 


A2 


00 






SBC 


#0 SUBTRACT THE BORROW. PTR3 < 0 ? 


0332 


24 


03 






BCC 


OK10 NO, WE'RE OK HERE. LOOK UP THE NEXT TWO DIGITS. 


0334 


AB 


64 






ADO 


#100 YES, MODIFY THE CTPTR, AND 


0336 


99 






**** 


SEC 


GENERATE A BORROW. 


0337 


B7 


14 




OK10 


STA 


PTR3 


0339 


97 








TAX 


-- 










**** 




-- LOOK UP THE NEXT TWO DIGITS IN THE TABLE 


033A 


06 


03 


BE 




LOA 


TABLE, X -- 


0330 


B7 


IB 






STA 


ONEDEG -- 


033 F 


24 


OC 






BCC 


DUNSUB AND CONTINUE ONLY IF THERE WAS A CARRY. 



**** 



101 



920 

921 

922 

923 

924 

925 

926 

927 

928 

929 

930 

931 

932 

933 

934 

935 

936 

937 

938 

939 

940 

941 

942 

943 

944 

945 

946 

947 

948 

949 

950 

951 

952 

953 

954 

955 

956 

957 

958 

959 

960 

961 

962 

963 

964 

965 

966 

967 

968 

969 

970 

971 

972 

973 

974 

975 

976 

977 

978 

979 

980 

981 

982 

983 

984 

985 



0341 


B6 13 




LDA 


PTR4 




0343 


A2 00 




SBC 


#0 


SUBTRACT THE BORROW. 


0345 


B7 13 




STA 


PTR4 


•• 


0347 


97 




TAX 




-- 






**** 






-- LOOK UP THE NEXT TWO DIGITS IN THE TABLE 


0348 


06 03 BE 




LDA 


TABLE, X 


-- 


034B 


B7 1A 


**** 


STA 


HUNDEG 


• • 


0340 


81 


DUN SUB 


RTS 










*** 












** 












** 



















** OUTPUT COUNT 


(OUTCT). SUBROUTINE TO MOVE THE CURRENT COUNT (BCDCT) 






** 


TO THE 


OUTPUT PORTS. 


REMOVES THE DECIMAL POINT FROM THE 






** 


DISPLAY AND BLANKS ALL BUT THE LEAST SIGNIFICANT DIGIT. ALSO 






IHt 

** 


SETS THE MINUS SIGN 


IF APPROPRIATE. 




034E 


OUTCT 

** 


EOU 


% 




034E 


B6 20 




LDA 


TENONE 




0350 


B7 02 


** 


STA 


PORTC 




0352 


B6 IF 


LDA 


HUNDRD 




0354 


B7 00 


** 


STA 


PORTA 




0356 


B6 IE 




LDA 


TENTHO 




0358 


B7 01 


** 


STA 


PORTB 




035A 


IE 01 


BSET 


DECPT,PORTB 




035C 


19 01 


** 


BCLR 


BLANK, PORTB 




035E 


04 25 04 


BRSET 


NEGTIV,STAT, MINUS 


0361 


1C 01 




BSET 


POSTIV, PORTB 




0363 


20 02 


** 


BRA 


ALLDUN 




0365 


ID 01 


MINUS 

** 


BCLR 


POSTIV, PORTB 




0367 


81 


ALLDUN 

** 


RTS 










*• 

** OUTPUT POSITION (OUTPOS). 


SUBROUTINE TO MOVE THE CURRENT POSITION 






** 


COUNT 


(BCDCT) TO THE 


OUTPUT PORTS. THE DECIMAL POINT IS 






** 

** 


DISPLAYED , AND ONLY 


THE MOST SIGNIFICANT DIGIT IS BLANKED. 




0368 


OUTPOS 

** 


EOU 


S 




0368 


B6 ID 


LDA 


THOUTH -- 




036A 


A1 05 




CMP 


#5 




036C 


25 38 




BLO 


TRUNC 


IF 5 > 'THOUTH' SIMPLY TRUNCATE THE 


036E 


B6 1C 




LDA 


HUNDTH 


-- DISPLAY. OTHERWISE... 


0370 


A4 09 




AND 


#9 


-- IF THE LAST DIGIT ISN'T A NINE IT IS 


0372 


A1 09 




CMP 


#9 


-- EASY TO ROUND UP. JUST ADD A ONE. 


0374 


26 28 




BNE 


DECIMAL 


-- 


0376 


B6 1C 




LDA 


HUNDTH 


-- BUT IF THE LAST DIGIT IS A NINE CHECK TO 


0378 


A1 99 




CMP 


#$99 


— SEE IF IT'S 99. IF SO IT GETS GRIM. 


037A 


27 04 




BEQ 


UGLY 




037C 


AB 07 




ADD 


#7 


-- IF THE NUMBER IS X9 AND X .NE. 9, THEN 


037E 


20 28 


** 


BRA 


PCOUT 


-- JUST ADD SEVEN TO ROUND UP. DUE TO 
-- HEXIDECIMAL. 






** 






-- IF THE LOW TWO DIGITS ARE BOTH NINES 


0380 


A6 00 


UGLY 


LDA 


#00 


- AND WE NEED TO ROUND UP 


0382 


B7 02 




STA 


PORTC 


MAKE THE LOW TWO DIGITS BOTH ZEROS 


0384 


99 




SEC 


-- 


AND SET THE CARRY. 



■ktt 



102 



986 


0385 


86 


18 










LDA 


ONEOEG -- CHECK THE LAST DIGIT AS BEFORE. 


987 


0387 


A4 


09 










AND 


#9 -- IF USING THIS PORTION OF THE CODE 


988 


0389 


A1 


09 










CMP 


#9 *• THERE HAD TO BE A CARRY. 


989 


038B 


26 


IE 










BNE 


NEXT -- IF THE LAST DIGIT IS NOT A NINE USE THE 


990 


0380 


86 


18 










LDA 


ONEDEG — ADC INSTRUCTION BELOW. 


991 


038F 


A1 


99 










CMP 


«S99 -- IF IT IS A NINE, IS THE NEXT ONE A NINE 


992 


0391 


27 


04 










BEQ 


RLUGLY -- ALSO? 


993 


0393 


AB 


07 










ADD 


#7 -- IF NOT JUST ADD SEVEN, 


994 


0395 


20 


18 










BRA 


PAOUT -- AND DISPLAY THE OUTPUT. 


995 














** 






996 


0397 


A6 


00 








RLUGLY 


LDA 


#00 


997 


0399 


87 


00 










STA 


PORTA -- IF SO ROUND UP THE MOST SIGNIFICANT 


998 


0398 


99 












SEC 


DIGIT AND SET EVERYTHING ELSE TO ZERO. 


999 


039C 


20 


13 










BRA 


MEXTI 


1000 














** 






1001 


039E 


86 


1C 








DECIMAL 


LDA 


HUNDTH -- 


1002 


03A0 


A8 


01 










ADD 


#1 


1003 














** 




-- THIS IS ALL THAT NEEDS TO BE DONE IF 


1004 


03A2 


87 


02 










STA 


PORTC -- THE LAST DIGIT IS NOT A NINE. 


1005 


03A4 


20 


05 










BRA 


NEXT 


1006 














** 






1007 


03A6 


86 


1C 








TRUNC 


LDA 


HUNDTH -- 


1008 


03A8 


87 


02 








PCOUT 


STA 


PORTC -• AND IF THERE IS NO CARRY IT'S EVEN EASIER. 


1009 


03AA 


98 












CLC 


-- 


1010 














** 






1011 


03AB 


86 


18 








NEXT 


LDA 


ONEDEG 


1012 


03AD 


A9 


00 










ADC 


#0 


1013 


03AF 


87 


00 








PAOUT 


STA 


PORTA 


1014 














** 






1015 


0381 


86 


1A 








NEXT1 


LDA 


HUNDEG 


1016 


0383 


A9 


00 










ADC 


#0 


1017 


0385 


87 


01 










STA 


PORTB 


1018 














** 






1019 


0387 


1C 


01 










BSET 


POSTIV,PORTB 


1020 


0389 


18 


01 










BSET 


BLANK, PORTB 


1021 


03BB 


IF 


01 










BCLR 


DECPT, PORTB 


1022 














** 






1023 


03BD 


81 












RTS 




1024 














** 






1025 














** 






1026 




















1027 














** 






1028 














** SET 


UP THE 


TABLE TO BE USED WITH BCD INCREHENT/DECREHENT ROUTINES. 


1029 














** 






1030 














* 


ENDS 




1031 














* 


DATA 




1032 


03BE 


00 


01 


02 


03 


04 


TABLE 


FCB 


SOO , $0 1 , $02 , $03 , S04 , $05 , $06 , $07, $08 , $09 




03C3 


05 


06 


07 


08 


09 








1033 


03C8 


10 


11 


12 


13 


14 




FCB 


$10, $11, $12, $13, $14, $15, $16, $17, $18, $19 




03CO 


15 


16 


17 


18 


19 








1054 


0302 


20 


21 


22 


23 


24 




FCB 


$20, $21, $22, $23, $24, $25, $26, $27, $28, $29 




0307 


25 


26 27 


28 


29 








1035 


03DC 


30 


31 


32 


33 


34 




FCB 


$30 , $3 1 , $32 , $33 , $34 , $35 , $36 , $37, $38 , $39 




03E1 


35 


36 37 


38 


39 








1036 


03E6 


40 


41 


42 


43 


44 




FCB 


$40, $41, $42, $43, $44, $45, $46, $47, $48, $49 




03EB 


45 


46 47 


48 


49 








1037 


03F0 


50 


51 


52 


53 


54 




FCB 


$50,$51,$52,$53,$54,$55,$56,$57,$58,$59 




03F5 


55 


56 


57 


58 


59 








1038 


03 FA 


60 


61 


62 


63 


64 




FCB 


$60 , $6 1 , $6 2 , $63 , $64 , $6 5 , $66 , $6 7 , $68 , $69 




03FF 


65 


66 67 


68 


69 








1039 


0404 


70 


71 


72 


73 


74 




FCB 


$70,$71,$72,$73,$74,$75,$76,$77,$78,$79 




0409 


75 


76 


77 


78 


79 






1040 


040E 


80 


81 


82 


83 


84 




FCB 


$80,$81,$82,$83,$84,$85,$86,$87,$88,$89 




0413 


85 


86 87 


88 


89 






1041 


0418 


90 


91 


92 


93 


94 




FCB 


$90 , $91 , $92 , $93 , $94 , $95 , $96 , $97, $98 , $99 




0410 


95 


96 97 


98 


99 







103 



1042 

1043 

1044 

1045 

1046 

1047 

104B 

1049 

1050 

1051 

1052 

1053 

1054 

1055 

1056 

1057 

1058 

1059 

1060 

1061 

1062 

1063 

1064 

1065 

1066 

1067 

1068 

1069 

1070 

1071 

1072 

1073 

1074 

1075 

1076 

1077 

1078 

1079 



EMOS 

CODE 



0422 



** SET UP MASK OPTION REGISTER. 

** 

ABSOLUTE 

** 



0F38 

0F38 07 



ORG NOR 

FCB l!BIT2-^BITUBIT0 

COMMENTS: 

BIT 7 CLOCK SOURCE 0 * CRYSTAL. 

BIT 6 TIMER OPTION 0 « INTERNAL. 

BIT 5 TINER/CLOCK SOURCE 0 > INTERNAL. 

BIT 4 NOT USED. 

BIT 3 NOT USED. 

BIT 2 SET - 

BIT 1 SET - PRESCALE SELECT 111 *> 128 
BIT 0 SET - 



************************************************************************ 



** 

** 



0FF8 




** 


ORG 


0FF8 


012E 




FDB 


OF FA 


014D 




FDB 


OFFC 


014D 




FDB 


OFFE 


0080 




FDB 



** 



ASSIGN INTERRUPT VECTORS. 

INTRPT 

BLINK TIMER/INT2 INTERRUPT VECTOR. 

COUNT EXTERNAL INTERRUPT VECTOR. 

COUNT SOFTWARE INTERRUPT VECTOR, NOT USED. 

RESTRT RESET VECTOR. 



1000 



ENDS 

END 



Lines Assembled : 1079 



Assembly Errors : 0 
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C TILT 



1 

2 

3 

4 

5 

6 

7 

8 
9 

10 



15 

16 

17 

18 

19 

20 
21 



31 

32 

33 



0004 



TTL 

* 

* 

*• 

PROGRAM DESCRIPTION 

*• 

*• 

** I/O REGISTER ADDRESSES 

*• 



POSITION DETERMINING PROGRAM (ELEVATION) 
LATEST REVISION 9 MAY 89 

FILE NAME TILT. ASM 



11 


0000 


PORTA 


EOU 


soooo 


I/O PORT A 


12 


0001 


PORTB 


EOU 


$0001 


I/O PORT B 


13 


0002 


PORTC 


EOU 


$0002 


I/O PORT C 


14 


0003 


PORTD 


EOU 


$0003 


INPUT PORT D 



DATA DIRECTION REGISTER OFFSET 



*• 

DDR 

** 

** OTHERS 

** 



EOU 



(eg. DDR FOR PORT A IS PORTA+DDR ) 



22 


0008 


TIMER 


EOU 


$0008 


EIGHT BIT TIMER REGISTER. 


23 


0009 


TCR 


EOU 


$0009 


TIMER CONTROL REGISTER. 


24 


OOOA 


MR 


EOU 


SOOOA 


MISCELLANEOUS REGISTER. 


25 


0010 


RAM 


EOU 


$0010 


START OF ON-CHIP RAM(112 - 31 FOR STACK) 


26 


0080 


ZROH 


EOU 


$0080 


PAGE ZERO OF ROM. 


27 


0100 


ROM 


EOU 


$0100 


START OF MAIN ROM. 


28 


0F38 


MOR 


EOU 


S0F38 


MASK OPTION REGISTER. 


29 


0FF8 


INTRPT 


EOU 


S0FF8 


LOCATION OF INTERRUPT VECTORS. 


30 


1000 


MEMSIZ 


EOU 


$1000 


MEMORY ADDRESS SIZE. 



EQUATES 



34 


0001 


BITO 


EOU 


1 


35 


0002 


BIT1 


EOU 


2 


36 


0004 


BIT2 


EOU 


4 


37 


0008 


BIT3 


EOU 


8 


38 


0010 


BIT4 


EOU 


16 


39 


0020 


BIT5 


EOU 


32 


40 


0040 


BIT6 


EOU 


64 


41 


0080 


BIT7 


EOU 


128 


42 




** 






43 


0000 


BO 


EOU 


0 


44 


0001 


B1 


EOU 


1 


45 


0002 


62 


EOU 


2 


46 


0003 


B3 


EOU 


3 


47 


0004 


B4 


EOU 


4 


48 


0005 


B5 


EOU 


5 


49 


0006 


66 


EOU 


6 


50 


0007 


B7 


EOU 


7 


51 




** 






52 




** EQUATES FOR 


THE ' 


53 




• • 






54 




• •• 






55 


0007 


TIR 


EOU 


7 


56 


0006 


TIM 


EOU 


6 


57 


0005 


TIN 


EOU 


5 


58 


0004 


TEE 


EOU 


4 


59 


0003 


PSC 


EOU 


3 


60 


0002 


PS2 


EOU 


2 


61 


0001 


PS1 


EOU 


1 



TIMER INTERRUPT REQUEST, 1 = REQUEST, 0 = NO REQ. 
TIMER INTERRUPT MASK. 1 = DISABLED, 0 = ENABLED. 
EXTERNAL OR INTERNAL CLOCK SOURCE. 1 = EXT, 0 = I NT. 
EXTERNAL CLOCK ENABLE. NOT USED. 

PRESCALER CLEAR. NOT USED. 

(PS2) -- 

(PSD I-- PRESCALER SELECT BITS. 
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62 

63 

64 

65 

66 

67 

68 

69 

70 

71 

72 

73 

74 

75 

76 

77 

78 

79 

80 

81 

82 

83 

84 

85 

86 

87 

88 

89 

90 

91 

92 

93 

94 

95 

96 

97 

98 

99 

100 

101 

102 

103 

104 

105 

106 

107 

108 

109 

110 

111 

112 

113 

114 

115 

116 

117 

118 

119 

120 

121 

122 

123 

124 

125 

126 

127 



EQU 



0 



(PSO) 



0000 



0007 

0006 

0005 

0004 

0003 

0002 



0007 

0006 

0004 



0007 

0006 

0005 

0004 



PSO 

** 



** EQUATES FOQ THE STATUS BYTE, 'STAT'. 



*** 












*** 
























UD 


EQU 


7 


COUNT DIRECTION? 1 > UP, 0 x DOWN. 






MOO 32 


EQU 


6 


IS 'BINCT' MODULO 32? 1 = YES, 0 * 


NO. 




FLASH 


EQU 


5 


BLINK THE DISPUY? 1 * YES, 0 * NO. 






POSCT 


EQU 


4 


DISPLAY POSITION OR COUNT? 1 « POS, 


0 X 


COUNT 


L.SET 


EQU 


3 


VALUE OF 'MODE, PORTO' UST TIME. 






NEGTIV 


EQU 


2 


IS 'BCOCT' NEGATIVE NUMBER? 1 * YES, 


0 * 


NO. 






1 


NOT USED. 






iHtit 




0 


NOT USED. 






*** 













1/0 EQUATES AND DESCRIPTIONS . 

*«* 



PORT A (1/0) 



*** 

*** 

*** 

*** BIT 

*** 

*** 

*** 

*** 







BCD 


DIGIT 


#4 




1 






BCD DIGIT Ki 






D4 


1 


C4 


1 


B4 1 


A4 


I 


D3 


1 


a 1 


B3 


1 


A3 


7 




6 




5 


4 




3 




2 


1 




0 



PORT B (I/O) 



-+ + 

DISPLAY CONTROL 
*** + ♦ + + 

*** 

*** BIT 
*** 



I 



I DECPT I POSTIVl 



I 



I BLANK I 

+ + - 

5 4 



+ 

NOT USED 
+ 

I 



DECPT EQU 
POST IV EQU 



BLANK 

*** 

*** 

*** 



EQU 



TO DISPLAY THE DECIMAL POINT. . .DECPT IS CLEARED 
USED TO DISPLAY NEGATIVE SIGN .. .CLEARED TO SHOW 
MINUS SIGN. 

TO BLANK DIGITS 2 AND 3... CLEAR BLANK. 

DIGITS 4 AND 5 ARE ALWAYS BLANKED. 

DIGIT 1 IS NEVER BLANKED. 



PORT C (I/O) 



... 1 




BCD 


DIGIT 


#2 


|BCD DIGIT 


#1 (LEAST 


SIGNIFICANT) 


... 1 

*** 4. 


D2 1 


C2 


1 


B2 1 


h ^ 

a 

■ 

< 


Cl 1 


B1 1 


A1 


*** BIT 


7 


6 




5 


4 3 


2 


1 


0 



*** 

*** 

*** 

*** 

*** bit 
*** 



PORT D (INPUT ONLY) 



I CH_A I INT2 I CH_B | FUNCT | SET 



CH A 


EQU 


7 


INDICATES THE STATUS OF 


CHANNEL A. 


INT2 


EQU 


6 


INTERRUPT #2. USED TO ( 


CHANGE DISPLAY MOOES. 


CH B 


EQU 


5 


INDICATES THE STATUS OF 


CHANNEL B. 


FUNCT 


EQU 


4 


USED TO PUT THE PROGRAM 


IN A MOOE THAT WILL ALLOW 
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0003 

0010 

0011 

0012 

0013 

0014 

0015 

0016 

0017 

0018 

0019 

001A 

001B 



SET 



EOU 



'HYST' TO BE INCREMENTED. 

INCREMENTS 'HYST' WHEN TOGGLED AND FUNCT IS LOW. 



** 



RAM VARIABLES 



** RESERVE MEMORY SPACE FOR THE PROGRAM VARIABLES. 






CTPTR2 EOU 
CTPTRI EOU 



DATA 



ABSOLUTE (ABSOLUTE ADDRESSING USED HERE TO RELATIVE DIRECTIVE) 
START OF RAM. 



HI BYTE. 
LO BYTE. 



EACH BYTE POINTS TO A POSITION IN THE 
TABLE THAT CONTAINS ONE OR TWO DIGITS 
OF THE BCD POSITION. 

MOST SIGNIFICANT DIGITS. 

LEAST SIGNIFICANT DIGIT. 



EACH BYTE POINTS TO A POSITION IN THE 
TABLE THAT CONTAINS TWO OF THE DIGITS 
IN THE BCD COUNT. 

MOST SIGNIFICANT DIGITS. 

LEAST SIGNIFICANT DIGITS. 



** 


ORG 


RAM 


** 






*** BINARY COUNT. 


BINCT 


RMB 


2 


HIBIN 


EOU 


BINCT 


LOBIN 


EOU 


BINCT+1 


** 






*** POSITION 


POINTERS. 


PTR 


RMB 


3 


** 






** 






PTR3 


EQU 


PTR 


PTR2 


EOU 


PTR^I 


PTR1 


EOU 


PTR+2 


** 






*** COUNT POINTERS. 


CTPTR 


RMB 


2 



CTPTR 

CTPTR+1 



BCD POSITION IN DEGREES. 



CONTENTS X 1.000 

CONTENTS X 0.010 

+ CONTENTS X 0.001 

POSITION IN DEGREES 



*** 

DEGRES RMB 
ONEDEG EOU 
HUNDTH EQU 

THOUTH EOU 

*** 

** 

*** BCD COUNT. 

BCDCT RMB 
HUNDRD 
TENONE 

*** 

*** 

*** 

*** HYSTERESIS COUNTER. POINTS TO A NUMBER IN THE TABLE THAT IS THE 
*** AMOUNT OF HYSTERESIS PRESENT IN THE SYSTEM. INITIALIZED TO 6. 

HYSTPT RMB 1 

** 



EOU 

EOU 



3 

DEGRES 

DEGRES+1 

DEGRES<*>2 



2 

BCDCT 

BCDCT+1 



CONTENTS X 
+ CONTENTS X 



100 

1 



NUMBER OF PULSES COUNTED 



*** POSITION INCREMENT. CONTAINS A NUMBER, THAT WHEN MULTIPLIED BY 0.001 
IS THE NUMBER OF DEGREES THAT THE POSITION COUNTER (BCDPOS) IS 
TO BE INCREMENTED OR DECREMENTED DURING PROGRAM EXECUTION. 

THE VALUE OF 'POSINC', DETERMINED EXPERIMENTALLY, SHOULD BE 
7.0452. SINCE THE PROGRAM IS DESIGNED WORK WITH INTEGERS ONLY 
THIS NUMBER IS ROUNDED TO 7. TO REDUCE THE CUMULATIVE EFFECT OF 
THE ROUND OFF, EVERY 32 COUNTS 'POSINC' IS SET EQUAL TO 8. THIS 
AGAIN LEADS TO SOME CUMULATIVE ERROR, BUT THE SMALL ANGULAR RANGE 



*** 
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194 

195 

196 

197 

198 

199 

200 
201 
202 

203 

204 

205 

206 

207 

208 

209 

210 
211 
212 

213 

214 



001D 



001E 



001 F 



0020 

0021 



*** OF THE TILT ANGLE (10.5 DEGREES) ALLOWS US TO NEGLECT ANY FURTHER 

MODIFICATIONS. 

*** 

PCS INC RHB 1 

*** 

HYSTERESIS VARIABLES. USED TO ELIMINATE THE EFFECTS OF BACKLASH ON 
THE POSITION MEASUREMENTS. 

HYST RM6 1 THE THRESHHOLD VALUE DETERMINED 

EXPERIMENTALLY. 

HYSTCT RM6 1 CURRENT AMOUNT OF HYSTERESIS MEASURED. 

*** 

*** STATUS BYTE. USED TO KEEP TRACK OF WHAT IS GOING ON. 

STAT RMB 1 CURRENT STATUS. 

LSTAT RMB 1 PREVIOUS/UST STATUS. USED TO KEEP TRACK OF 

L^SET ONLY. 

*** ~ 

TIMER COUNTER. USED IN CONJUNCTION WITH THE TIMER PRESCALER AND THE 
TDR TO KEEP TRACK OF ONE SEC. INTERVALS. USED IN BLINKING THE 
DISPLAY. INITIALLY SET TO 31, WHEN THE 'FLASH' BIT OF 'STAT' 



215 








IS SET. TIMCT 


IS DECREHENTED EACH CLXK INTERRUPT (APPROX. 31 


216 






*** 


TIMES 


PER SEC), 


. RESET TO 31 WHEN CONTENTS GO TO ZERO. 


217 






*** 


WHEN 


(TIMCT)=0 


THE DISPLAY WILL TOGGLE. 


218 






*** 








219 


0022 




TIMCT 


RHB 


1 




220 






** 








221 








ENDS 






222 






** 








223 














224 






************************************************************************ 


225 






** 






★ 


226 






** 






PAGE ZERO ROM 


227 






** 






♦ 


228 








229 






** 








230 










INITIALIZATION ROUTINE. 


231 






** 








232 






** 








233 


0000 






CC»E 






234 






** 








235 


0080 






ORG 


ZROM 


PAGE ZERO ROH. 


236 






** 








237 


0080 






RELATIVE 


RELATIVE ADDRESSING HUST BE USED FOR THE BRANCH. 


238 






** 








239 




0080 


RESTRT 


EQU 


S 


THIS IS THE ENTRY POINT WHEN AN EXTERNAL 


240 






*** 






INTTERRUPT OCCURS. 


241 














242 














243 






** 








244 






*** 




INITIALIZE THE PC AND CLEAR RAH. 


245 






*** 








246 






*** 








247 


0080 


9B 




SEI 




SET INTERUPT TO AVOID INTERUPTION AND 


248 


0081 


9C 




RSP 




RESET THE STACK POINTER. JUST IN CASE! 


249 






*** 








250 


0082 


AE 10 




LDX 


#BINCT 


CLEAR ALL OF THE VARIABLES BETWEEN 


251 


0084 


7F 


CLRIT 


CLR 




'BINCT' AND 'TIHCT' ( INCLUSIVE) .NOTE 


252 


0085 


5C 




INCX 




THAT THIS SETS THE COUNTER AND THE POS- 


253 


0086 


A3 22 




CPX 


#TIHCT 


ITION TO ZERO. THIS HEANS THAT ROTATION 


254 


0088 


23 FA 




BLS 


CLRIT 


SHOULD START IN AN INCREASING (CW> 


255 






*** 






DIRECTION FROM THE MOST CCW POSITION 


256 






*** 






AFTER A RESET. 


257 






*** 




- 




258 


008A 






ABSOLUTE 


BACK TO ABSOLUTE ADDRESSING. 


259 






*** 
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260 

261 

262 

263 

264 

265 

266 

267 

268 

269 

270 

271 

272 

273 

274 

275 

276 

277 

278 

279 

280 

281 

282 

283 

284 

285 

286 

287 

288 

289 

290 

291 

292 

293 

294 

295 

296 

297 

298 

299 

300 

301 

302 

303 

304 

305 

306 

307 

308 

309 

310 

311 

312 

313 

314 

315 

316 

317 

318 

319 

320 

321 

322 

323 

324 

325 






ESTABLISH I/O PORTS. 



008A 


A6 FF 


LDA 


#-1 


PORTS A,B,C 


ARE CONFIGURED AS 


008C 


B7 04 


STA 


PORTA'K)DR 


ALL OUTPUT. 


PORT D IS ALL INPUT 


008E 


B7 05 


STA 


PORTB+DDR 


SO THERE IS 


NO MASK TO SET. 


0090 


B7 06 


STA 


PORTC*K)OR 














*** 

*** 




SET UP THE STATUS REGISTER. 


0092 


A6 08 




LDA 


#X00001000 -- 


0094 


B4 03 




AND 


PORTD |--> SET UP 'L SET' BIT OF 'STAT'. 


0096 


B7 20 


*♦* 


STA 


STAT 


0098 


1C 20 


** 


BSET 


MOO_32,STAT 0 IS NOOULO 32. 



009A A6 06 
009C B7 IE 
009E B7 1C 



INITIALIZE HYSTCT. 

LDA #06 

STA HYST 

STA HYSTPT 

************************************************************************ 



OOAO A6 47 



00A2 B7 09 



** SET UP THE TIMER FOR A 4 MHZ CRYSTAL / 4 = 1 MHZ CLOCK. 

*** 

*♦* NOTE: THE MASK OPTION REGISTER IS IN ROM. IT IS SET UP AT 

*** THE END OF THE PROGRAM. 

*** 

********************* ggj yp TCR. ******************************** 
♦** 

LDA #BIT6*BIT2-»-BITUBIT0 

*** (TIM)|(PS2)(PS1)(PS0) 

♦♦♦(DISABLE INTERRUPT) ((PRESCALE BY 128) 

*** 

STA TCR 

*** 



♦♦♦ SET UP THE TIMER. 

*** 



00A4 A6 FF 

00A6 B7 08 



LDA #255 1 MHZ/(128^255) = 30.6 (APPROX. 31) 

STA TIMER 



00A8 A6 IF 

OOAA B7 22 



**************** initialize the TIMER COUNTER. *********************** 
*** 

LDA #31 PROVIDES FOR 1 SEC. BLINK INTERVAL. 

STA TIMCT FOR 2 SEC. INTERVAL JUST USE TIMECT=62, etc. 

*** 

*** 

********************************************************************** 



OOAC ID OA 



♦♦ SET UP MISCELLANEOUS REGISTER. 

** 

BCLR B6,MR ENABLES THE SECOND INTERRUPT. 

** 

************************************************************************ 



** 

** 



COUNT = 0 IS DISPLAYED INITIALLY. 



OOAE CD 02 D8 

00B1 1C 01 



JSR OUTCT 

BSET POSTIV,PORTB 
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326 

327 

328 

329 

330 

331 

332 

333 

334 

335 

336 

337 

338 

339 

340 

341 

342 

343 

344 

345 

346 

347 

348 

349 

350 

351 

352 

353 

354 

355 

356 

357 

358 

359 

360 

361 

362 

363 

364 

365 

366 

367 

368 

369 

370 

371 

372 

373 

374 

375 

376 

377 

378 

379 

380 

381 

582 

383 

384 

385 

386 

387 

388 

389 

390 

391 



00B3 9A 
00B4 



CLI CLEAR THE INTERRUPT HASK TO GET STARTED. 

RELATIVE RELATIVE ADDRESSING MUST BE USED FOR THE 

REMAINDER OF THE PROGRAM. 

*«* 



** UAIT LOOP. EXECUTES, UNTIL AN INTERRUPT OCCURS. 



00S4 


09 03 OB 


PAUSE 

It* 


BRCLR 


FUNCT,PORTD,CHHYST 


WANT TO CHANGE HYST? 
YES... 00 TO CHHYST. 


00B7 


06 03 04 




BRSET 


SET, PORTO, SBIT 


NO... 'SET, PORTO' SET? 


OOBA 


17 20 




BCLR 


L SET,STAT 


NO... CLEAR 'L SET,STAT' 


OOBC 


20 F6 




BRA 


PAUSE 


AND LOOP. 


OOBE 


16 20 


SBIT 


BSET 


L SET,STAT 


YES... SET 'L SET,STAT' 


OOCO 


20 F2 




BRA 


P^E 


AND LOOP. ” 






** HYSTERESIS MODIFICATION ROUTINE. PERMITS MODIFICATION OF THE 
** HYSTERESIS BUFFER WITHOUT REPROGRAMMING. 















YES... 




00C2 


A6 40 




CHHYST 


LDA 


#6IT6 


DISABLE TIMER INTERRUPT. 


00C4 


B7 09 




*** 


STA 


TCR 






00C6 


A6 08 






LDA 


#X00001000 


SAVE 'L SET' 




00C8 


B4 20 






AND 


STAT 


INTO 




OOCA 


B7 21 






STA 


LSTAT 


'LSTAT'. 




OOCC 


A6 08 






LDA 


#X00001000 






OOCE 


B4 03 






AND 


PORTD 


'SET, PORTD' ACCUMULATOR 


OODO 


B1 21 






CMP 


LSTAT 


HAS THE SET SWITCH BEEN CHANGED? 


00D2 


27 15 




*** 


BEQ 


DISPLA 


YES... 




00D4 


A6 08 






LDA 


#X00001000 


-- 




0006 


B8 20 






EOR 


STAT 


|-->CHANGE 'L SET, ST AT', 


0008 


B7 20 






STA 


STAT 


— 




OODA 


3C IE 






INC 


HYST 


THEN INCREMENT THE HYSTERESIS 


OOOC 


3C 1C 




*** 


INC 


HYSTPT 


POINTER AND 'HYST'... 




OODE 


B6 1C 






LDA 


HYSTPT 


-- 




OOEO 


A1 19 






CMP 


#25 


-- 




00E2 


23 05 






BLS 


DISPLA 


•• 
















-- BUT NOT ABOVE 25. 


00E4 


4F 






CLRA 




THEN--> 




00E5 


B7 IE 






STA 


HYST 


-- 




00E7 


B7 1C 




*** 


STA 


HYSTPT 


*■ *■ 




00E9 


A6 00 




DISPLA 


LDA 


#X00000000 


NO... JUST > 




OOEB 


B7 00 






STA 


PORTA 






OOED 


A6 CO 






LDA 


#%1 1000000 


-- 




OOEF 


B7 01 






STA 


PORTB 


\ 


/ 








*** 






•• DISPLAY CURRENT ‘HYST'. 


00F1 


BE 1C 






LDX 


HYSTPT 


-- 




00F3 


D6 03 


28 




LDA 


TABLE, X 


-- 




00F6 


B7 02 






STA 


PORTC 


-- 










*** 






IS 'HYST' SETTING COMPLETE? 


00F8 


09 03 


C7 




BRCLR 


FUNCT, PORTD, CHHYST 


NO... KEEP CHECKING ' 


‘SET'. 


OOFB 


04 20 


04 




BRSET 


NEGTIV, STAT, SIGN 


YES... RESET THE DISPLAY. 


OOFE 


1C 01 






BSET 


POSTIV, PORTB 






0100 


20 02 






BRA 


DIR 






0102 


ID 01 




SIGN 


BCLR 


POSTIV, PORTB 






0104 


08 20 


05 


DIR 

** 


BRSET 


POSCT,STAT,SHOPOS 






0107 


CD 02 


D8 


JSR 


OUTCT 






01 OA 


20 03 






BRA 


DUNCHG 







110 



*** 



392 



393 


010C 


CD 


02 E5 


SHOPOS 


JSR 


OUTPOS 




394 








*** 








395 


010F 


OB 


20 04 


DUNCHG 


BRCLR 


FLASH, STAT, NO I NT 


IF THE DISPLAY IS TO BLINtC... 


396 


0112 


A6 


07 




LDA 


MBIT2+BITUBIT0 


ENABLE TIMER INTERRUPT AND RESET 


397 


0114 


B7 


09 




STA 


TCR 


TIMER PfiESCALER 


398 


0116 


20 


9C 


NO^INT 


BRA 


PAUSE 


PRIOR TO RETURNING. 


399 








*** 








400 








** 









401 

402 

403 

404 

405 

406 

407 

408 

409 

410 

411 

412 

413 

414 



440 

441 

442 

443 



** MAXIMUM EXECUTION TIME FON THE REMAINDER OF THE PROGRAM OCCURS 
^ IF THE COUNTER ROTATES THROUGH ZERO AS THE DISPLAY MODE IS CHANGED 
** FROM THE BLINKING MODE TO THE COUNT MODE AT THE SAME TINE THAT THE 
** BLINKING ROUTINE IS CAUSING THE DISPLAY TO TOGGLE TO SHOW THE 
** POSITION IN DEGREES- 

MAXIMUM EXECUTION TIME * 67 ♦ 140 ♦ 618 * 825 CLOCK CYCLES. 



**MOOE 



CHANGE ROUTINE. CHANGES THE DISPLAY MODE FROM 

COUNT •> POSITION -> BLINKING -> COUNT -> (ETC.) 

MAXIMUM EXECUTION TIME OF 127 CLOCK CYCLES OCCURS WHEN THE 
DISPLAY MODE IS CHANGED FROM DISPLAYING THE COUNT TO DISPLAYING 



415 










** 


THE POSITION (IN DEGREES). 




416 










** 


IF THE 


DISPLAY IS CHANGED 


FROM BLINKING TO A COUNT DISPLAY 


417 










** 


EXECUTION TIME IS 67 CLOCK CYCLES. 


418 










** 








419 


0118 


IF 


OA 




CHMODE 


BCLR 


B7,MR 


AVOID REPEATED INTERRUPTS. 


420 










** 








421 


011A 


OA 


20 


10 




BRSET 


FLASH, STAT,DIS CT 


IF FLASHING, DISPLAY COUNT... 


422 


011D 


09 


20 


07 




BRCLR 


POSCT, ST AT, DISPOS 


IF SHOWING COUNT, DISPLAY POSITION... 


423 


0120 


1A 


20 






BSET 


FLASH, STAT 


ELSE, BLINK. 


424 










** 








425 


0122 


A6 


07 






LDA 


#BIT2+BIT1+BIT0 


ENABLE TIMER INTERRUPT AND RESET 


426 


0124 


B7 


09 






STA 


TCR 


TIMER PRESCALER. 


427 


0126 


80 








RTI 






428 










** 








429 


0127 


18 


20 




DISPOS 


BSET 


POSCT, STAT 




430 


0129 


CO 


02 


E5 




JSR 


OUTPOS 


DISPLAY CURRENT POSITION, AND WAIT 


431 


012C 


80 








RTI 


-- 




432 










** 








433 


01 2D 


A6 


47 




DIS^CT 


LDA 


#8IT64-BIT2+BIT1+BIT0 DISABLE TIMER INTERRUPT AND RESET 


434 


012F 


B7 


09 






STA 


TCR 


TIMER PRESCALER. 


435 


0131 


19 


20 






BCLR 


POSCT, STAT 




436 


0133 


IB 


20 






BCLR 


FLASH, STAT 


1 


437 










** 






j-- DISPLAY CURRENT COUNT, AND WAIT. 


438 


0135 


CO 


02 D8 




JSR 


OUTCT 


1 


439 


0138 


80 








RTI 


-- 





************************************************************************ 

** 

** BLINK ROUTINE. INTERRUPT ROUTINE TO CHANGE THE DISPLAY FROM POSITION 



444 






** 


TO COUNT OR VICE VERSA 


EVERY 31 ST TIMER INTERRUPT IF THE 


445 






** 


'FLASH' 


BIT OF 'STAT' 


IS SET. 


U6 






** 


MAXIMUM 


1 EXECUTION TIME 


OF 140 CLOCK CYCLES OCCURS WHEN THE 


447 






** 


DISPLAY 


IS TOGGLED FROM A COUNT DISPLAY TO A POSITION DISPLAY. 


448 






** 








449 




0139 


BLINK 


EOU 


S 




450 


0139 


OF 09 DC 




BRCLR 


TIR,TCR,CHMOOE 


IF THE INTERRUPT WAS NOT A TIMER 


451 






** 






INTERRUPT IT MUST BE FROM INT2. 


452 






** 








453 


013C 


IF 09 




BCLR 


TIR,TCR 


AVOID REPEATED TIMER INTERRUPTS. 


454 






** 








455 


013E 


3A 22 




DEC 


TIMCT 


IF THERE HAVE BEEN 31 TIMER 


456 


0140 


27 01 




BEQ 


CHGDIS 


INTERRUPTS (1 SEC), IT'S TIME TO 



457 



CHANGE THE DISPLAY. 



Ill 



458 

459 

460 

461 

462 

463 

464 

465 

466 

467 

468 

469 

470 

471 

472 

473 

474 

475 

476 

477 

478 

479 

480 

481 

482 

483 

484 

485 

486 

487 

488 

489 

490 

491 

492 

493 

494 

495 

496 

497 

498 

499 

500 

501 

502 

503 

504 

505 

506 

507 

508 

509 

510 

511 

512 

513 

514 

515 

516 

517 

518 

519 

520 

521 

522 

523 



0142 


80 




** 


RTI 


OTHERWISE, IT'S BACK TO WORK. 


0143 


A6 


IF 


CHGOIS 


LDA 


#31 RESET TIMCT TO 31 (1 SEC. INTERVAL) 


0145 


B7 


22 


** 


STA 


TIMCT 


0147 


B6 


20 




LDA 


STAT 


0149 


A8 


10 




EOR 


#*00010000 I” CHANGE 'POSCT' BIT OF 'STAT'. 


014B 


B7 


20 


itk 


STA 


STAT 


0140 


08 


20 04 


«r* 


BRSET 


POSCT, ST AT, POSOUT DECIDE ON CORRECT DISPLAY. 

CHANCE THE DISPLAY TO SHOW THE COUNT *♦***♦♦*♦*♦**** 


















*■* 






0150 


CD 


02 D8 




JSR 


OUTCT 


0153 


80 






RTI 












OR HAVE THE DISPLAY SHOW THE POSITION. ♦★♦♦♦♦^★♦^****** 








** 






0154 


CO 


02 E5 


POSOUT 


JSR 


OUTPOS 


0157 


80 






RTI 








******♦************♦*****♦**♦*♦♦***♦♦*♦****♦***♦*«** *******<H^***««r****** 
♦* 

** COUNT ROUTINE. 

** WHEN A COUNT IS RECEIVED THIS IS THE ENTRY POINT . 

♦♦ MAXIMUM EXECUTION TIME OF 618 CLOCK CYCLES OCCURS WHEN THE 

** COUNTER ROTATES CCW THROUGH ZERO AND THE POSITION (IN DEGREES) 

** IS BEING DISPLAYED. 

** 



** CURRENT DIRECTION OF ROTATION IS DETERMINED BY INSPECTING THE STATUS 
** OF 'CH A' AND 'CH B'. THE FOUR POSSIBILITIES AND THE ASSOCIATED 
** DIRECTION OF ROTATION ARE AS SHOWN BELOW. NOTE THAT THIS SCHEME 
** PREVENTS MULTIPLE OSCILLATIONS ABOUT A SINGLE POINT FROM 
** REPEATEDLY INCREMENTING OR DECREMENTING THE COUNTER. 



** 

** 


▼ 

1 CH_A 1 
1 1 


CH^B 


1 DIRECTION 1 

1 OF ROTATION | 


1 COUNT THE FHJLSE? 

[ 


** 


1 LO 1 


LO 


1 CW 


NO 


** 


1 LO 1 


HI 


1 CCW 


YES 


** 


1 HI 1 


LO 


1 CCW 


NO 


** 


1 HI 1 


HI 


1 CW 


YES 



+ + + + + 



FIRST SEE IF WE ARE SUPPOSED TO COUNT THIS INTERUPT. 



0158 

0158 OA 03 01 
01 5B 80 



COUNT EOU 


$ 




BRSET 


CH_B,PORTD,OKCT 


IF CH B IS LO WE DON'T COUNT THE 


RTI 




INTERRUPT. 



IF THE INTERRUPT IS VALID UPDATE 'STAT'. ************** 



015C 


A6 


7F 


015E 


B4 


20 


0160 


B7 


20 


0162 


A6 


80 


0164 


B4 


03 


0166 


BA 


20 


0168 


B7 


20 



016A OE 20 09 



OKCT 


LDA 


#X01111111 








AND 


STAT 


SAVE ALL OF THE OLD 'STAT' EXCEPT THE 






STA 


STAT 


DIRECTION OF ROTATION. 






LDA 


ni 0000000 








AND 


PORTD 


'CH A, PORTD' INDICATES THE DIRECTION 


* 




ORA 


STAT 


OF ROTATION AND BECOMES 'UD,STAT'. 
ADD THE RESULTS TO GET 


** 




STA 


STAT 


THE NEW 'STAT'. 


** 


DECIDE IF 


THE "SLACK" DUE 


TO BACKLASH/HYSTERESIS HAS BEEN TAKEN OUT 



** 



BRSET UO,STAT,HYSTCK IF ROTATING CW SEE BELOW. 



112 



524 


0160 


B6 


IF 




LDA 


HYSTCT 


ELSE, SEE IF WE DECREMENT THIS TIME. 


525 


016F 


27 


4B 




BEQ 


CCW 


IF HYSTCT*0, GO TO THE COUNT DOWN 


526 








** 






ROUTINE. 


527 


0171 


AO 


01 




SUB 


#1 


ELSE, DECREMENT THE HYSTERESIS COUNTER, 


528 


0173 


B7 


IF 




STA 


HYSTCT 




529 


0175 


80 






RTI 




AND WAIT FOR THE NEXT INTERRUPT. 


530 








** 








531 


0176 


86 


IE 


HYSTCK 


LDA 


HYST 


IF ROTATING CW 


532 


0178 


B1 


IF 




CMP 


HYSTCT 


AND HYST « HYSTCT 


533 


01 7A 


27 


03 




BEQ 


CW 


COUNT THE PULSE . 


534 


017C 


3C 


IF 




INC 


HYSTCT 


ELSE, INCREMENT THE HYSTERESIS COUNTER, 


535 


017E 


80 






RTI 




AND WAIT FOR ANOTHER PULSE. 


536 








** 








537 








** 








538 
















539 








** 








540 








** 




CLOCICUISE ROUTINE. 


541 








** 








542 




017F 


CU 


EOU 


S 




543 








** 








544 








**■* 








545 








************** 


INCREMENT THE 


BINARY COUNTER (BINCT). ***************** 


546 








*** 








547 


017F 


86 


11 




LDA 


L06IN BEGIN 


AT THE LSB OF THE BINARY COUNTER. 


548 


0181 


AB 


01 




ADD 


#1 L06IN 


= L06IN + 1 ; CARRY -> C,CCR 


549 


0183 


B7 


11 




STA 


L06IN 




550 








*** 








551 


0185 


86 


10 




LDA 


HIBIN 




552 


0187 


A9 


00 




ADC 


#0 


ADD THE CARRY TO THE HIGH BYTE. 


553 


0189 


B7 


10 




STA 


HIBIN 




554 








*** 








555 








*** 








556 








*.*****.**•••****« CLR/SET MC» 32 APPROPRIATELY. ****••****•******••** 


557 








*** 








558 


018B 


B6 


11 




LDA 


L06IN 


IF THE LOW FIVE BITS OF 'L06IN' ARE NOT 


559 


0180 


A4 


IF 




AND 


#X00011111 


NOT THEN THE NUMBER ISN'T A MODULO 32 NUMBER 


560 


018F 


26 


04 




BNE 


NOT_32 




561 








*** 








562 


0191 


1C 


20 




BSET 


M(X_32,STAT 




563 


0193 


20 


02 




BRA 


DIRCHK 




564 








*** 








565 


0195 


ID 


20 


NOT_32 


BCLR 


MOO_32,STAT 




566 








***“ 








567 








*** 








568 


0197 


B6 


10 


DIRCHK 


LDA 


HIBIN 




569 


0199 


2B 


19 




8HI 


CWNEG 


IF HIBIN < 0 , WE'RE ROTATING CW TOWARD 


570 








*** 






THE ORIGIN. 


571 








*** 








572 


019B 


26 


10 




BNE 


CWPOS 


ELSE IF BINCT .NE. 0 , 


573 


0190 


B6 


11 




LDA 


L06IN 


WE'RE ROTATING CW 


574 


019F 


26 


OC 




BNE 


CWPOS 


AWAY FROM THE ORIGIN. 


575 








*** 








576 


01A1 


15 


20 




BCLR 


NEGTIV,STAT 


ELSE, WE'VE GONE THROUGH ORIGIN IN CW 


577 








*** 






DIRECTION. CLR NEGATIVE SIGN. 


578 


01A3 


AE 


12 




LDX 


#PTR3 -- 




579 


01A5 


7F 




CLRIT2 


CLR 






580 


01A6 


5C 






INCX 




-RESET ALL COUNTERS AND DEGRES TO ZERO. 


581 


01A7 


A3 


19 




CPX 


#THOUTH 




582 


01A9 


23 


FA 




BLS 


CLRIT2 -- 




583 


01AB 


20 


4C 




BRA 


UPOUT 


UPDATE OUTPUT. 


584 








*** 








585 


01AD 


AD 


5E 


CW90S 


BSR 


ADDBCD 




586 


01AF 


CD 


02 32 




JSR 


INCPOS 




587 


01B2 


20 


45 




BRA 


UPOUT 




588 








*** 








589 


01B4 


CD 


02 7A 


CWNEG 


JSR 


SUBBCD 





113 



590 


01 B7 


CO 


02 9A 




JSR 


DECPOS 


591 


01 BA 


20 30 




BRA 


UPOUT 


592 








*** 






593 








** 






594 










595 








** 






596 








** 




COUNTER -CLOCICWISE ROUTINE. 


597 








** 






598 




01 BC 


CCW 


EQU 


$ 


599 








** 






600 








trIHt 






601 












'•**** CLR/SET MOO_32 APPROPRIATELY. ********************* 


602 














603 


01 BC 


B6 


11 




LOA 


LOGIN IF THE LOU FIVE BITS OF 'LOGIN' ARE NOT 


604 


01 BE 


A4 


IF 




AND 


BX00011111 ZERO THEN THE NUMBER ISN'T A MODULO 32 NUMBER 


605 


01 CO 


26 


04 




BNE 


NO 32 


606 














607 


01C2 


1C 


20 




BSET 


MOO 32,STAT 


608 


01C4 


20 


02 




BRA 


DECBIN 


609 








*** 






610 


01C6 


ID 


20 


NO 32 


BCLR 


MOO 32.STAT 


611 








*** 






612 








*** 






613 








•**••**•••*•••* decrement the binary counter (BINCT). *•*••****•**•*•* 


614 








*** 






615 


01 C8 


B6 


11 


DECBIN 


LOA 


LOGIN BEGIN AT THE LSB OF THE BINARY COUNTER. 


616 


01 CA 


AO 


01 




SUB 


#1 LOBIN = LOBIN • 1 ; BORROW •> C,CCR 


617 


01 CC 


B7 


11 




STA 


LOGIN 


618 








*** 






619 


01CE 


B6 


10 




LOA 


HIBIN 


620 


01D0 


A2 


00 




SBC 


#0 SUBTRACT THE CARRY FROM THE HIGH BYTE. 


621 


0102 


B7 


10 




STA 


HIBIN 


622 








*** 






623 


0104 


B6 


10 




LOA 


HIBIN 


624 


0106 


2A 


IB 




BPL 


CCUPOS IF HIBIN .GE. 0 , WE'RE ROTATING CCW TOWARD 


625 








*** 




THE ORIGIN. 


626 


0108 


A1 


FF 




CMP 


#•1 


627 


010A 


26 


10 




BNE 


CCWNEG - ELSE IF BINCT .NE. -1 , 


628 


010C 


B6 


11 




LOA 


LOBIN —WE'RE ROTATING CCW AWAY 


629 


010E 


A1 


FF 




CMP 


#-1 - FROM THE ORIGIN. 


630 


01E0 


26 


OA 




BNE 


CCWNEG — 


631 


01E2 


14 


20 




BSET 


NEGTIV.STAT ELSE, WE'VE GONE THROUGH ORIGIN IN CCW 


632 








*** 




DIRECTION. SET NEGATIVE SIGN. 


633 








*** 




AND SET ALL COUNTERS APPROPRIATELY. 


634 


01E4 


AE 


12 




LDX 


#PTR3 - 


635 


01E6 


7F 




CLREM 


CLR 




636 


01E7 


5C 






INCX 


- RESET ALL COUNTERS AND DEGRES TO ZERO. 


637 


01E8 


A3 


19 




CPX 


#THOUTH - 


638 


01EA 


23 


FA 




BLS 


CLREM 


639 








*** 






640 


01EC 


AD 


IF 


CCUNEG 


BSR 


ADDBCD 


641 


01EE 


CO 


02 32 




JSR 


INCPOS 


642 


01F1 


20 


06 




BRA 


UPOUT 


643 








*** 






644 


01 F3 


CD 


02 7A 


CCWPOS 


JSR 


SUBBCD 


645 


01 F6 


CO 


02 9A 




JSR 


DECPOS 


646 








*** 






647 








*** 






648 








** 






649 








************************************************************************ 


650 








** 






651 








** OUTPUT ROUTINE. ROUTINE TO PRINT DATA TO THE OUTPUT PORTS. BY 


652 








** 


CALLING THE APPROPRIATE SUBROUTINE. ( 'OUTCT' TO OUTPUT THE 


653 








** 


THE 


COUNT AND 'OUTPOS' TO OUTPUT THE POSITION). 


654 








** 






655 




01 F9 


UPOUT 


EQU 


$ 



114 



656 








*«r 






657 


01 F9 


04 


20 04 




BRSET 


NEGTIV,STAT, MINUS -- 


658 


01FC 


1C 


01 




BSET 


POSTIV,PORTB 


659 


01FE 


20 


02 




BRA 


DISCHK 


660 








** 




SET THE NEGATIVE SIGN 


661 


0200 


ID 


01 


MINUS 


BCLR 


POSTIV,PORTB - APPROPRIATELY. 


662 








** 






663 


0202 


09 


20 04 


DISCHK 


BRCLR 


POSCT,STAT, PUTCT 


664 








** 






665 


0205 


CD 


02 E5 




JSR 


OUTPOS 


666 


0208 


80 






RTI 




667 








** 






668 


0209 


CO 


02 08 


PUTCT 


JSR 


OUTCT 


669 


020C 


80 






RTI 




670 








** 






671 














672 








*********** SUBROUTINE TO INCREMENT THE BCD COUNTER (BCOCT). ********* 


673 








*** 






674 


0200 


B6 


16 


ADDBCD 


LDA 


CTPTR1 


675 


020F 


AB 


01 




ADD 


#1 


676 


0211 


A1 


63 




CMP 


#99 CTPTR > 99 ? 


677 


0213 


23 


05 




BLS 


OKI NO, UE'RE OK HERE. LOOK UP THE FIRST TWO DIGITS. 


678 


0215 


AO 


64 




SUB 


#100 YES... MODIFY THE CTPTR, 


679 


0217 


99 






SEC 


SET THE CARRY, AND 


680 


0218 


20 


01 




BRA 


OKU USE TABLE LOOK UP. 


681 








*** 






682 


021A 


98 




OKI 


CLC 


NO CARRY EXISTS IF WE ENTER AT THIS POINT 


683 


021B 


B7 


16 


0K1A 


STA 


CTPTR1 -- 


684 


021D 


97 






TAX 


-- 


685 








*** 




-• LOOK UP THE TWO LEAST SIGNIFICANT DIGITS. 


686 


021E 


06 


03 28 




LDA 


TABLE, X 


687 


0221 


B7 


IB 




STA 


TENONE -- 


688 


0223 


24 


OC 




BCC 


NOMO AND CONTINUE ONLY IF THERE WAS A CARRY. 


689 








*** 






690 








*** 






691 


0225 


B6 


15 




LDA 


CTPTR2 


692 


0227 


A9 


00 




ADC 


#0 ADD THE CARRY. 


693 


0229 


B7 


15 




STA 


CTPTR2 -- 


694 


022B 


97 






TAX 




695 








*** 




-- LOOK UP THE NEXT TWO DIGITS IN THE TABLE. 


696 


022C 


06 


03 28 




LDA 


TABLE,X -- 


697 


022F 


B7 


1A 




STA 


HUNDRD -- 


698 








*«r* 






699 


0231 


81 




NOHO 


RTS 




700 








*** 






701 














702 










^ SUBROUTINE TO INCREMENT THE POSITION COUNTER (DEGRES). ***♦♦♦* 


703 








*** 






704 








**** 1 


URST CHECK TO SEE IF THE BINARY COUNTER HAS REACHED A MODULO 32 


705 








**** 


NUMBER. 




706 














707 


0232 


00 


20 04 


INCPOS 


BRCLR 


M0D_32,STAT,INC7 'MOD_32,STAT' SET ? 


708 














709 


0235 


A6 


08 




LDA 


#8 YES . . . 


710 


0237 


20 


02 




BRA 


INC INCREMENT THE POSITION BY 0.008 DEGREES. 


711 








**** 






712 


0239 


A6 


07 


INC7 


LDA 


#7 NO 


713 


023B 


B7 


ID 


INC 


STA 


POSINC INCREMENT THE POSITION BY 0.007 DEGREES. 


714 








***« 






715 








***• ROUTINE TO 


INCREMENT THE POSITION COUNTER , 'DEGREES' , BY A 


716 








**** 


PREDETERMINED AMOUNT, 'POSINC'. 


717 








**** 






718 


0230 


B6 


14 




LDA 


PTR1 


719 


023F 


BB 


ID 




ADD 


POSINC 


720 


0241 


A1 


09 




CMP 


#9 PTR1 >97 


721 


0243 


23 


05 




BLS 


OK3 NO, WE'RE OK HERE. LOOK UP THE FIRST DIGIT. 



115 



722 

723 

724 

725 

726 

727 

728 

729 

730 

731 

732 

733 

734 

735 

736 

737 

738 

739 

740 

741 

742 

743 

744 

745 

746 

747 

748 

749 

750 

751 

752 

753 

754 

755 

756 

757 

758 

759 

760 

761 

762 

763 

764 

765 

766 

767 

768 

769 

770 

771 

772 

773 

774 

775 

776 

777 

778 

779 

780 

781 

782 

783 

784 

785 

786 

787 



0245 


AO 


OA 






SUB 


#10 


YES... HOOIFY THE CTPTR, 


0247 


99 








SEC 




SET THE CARRY, AND 


0248 


20 


01 




**** 


BRA 


OC3A 


USE TABLE LOOX UP. 


024A 


98 






0*3 


CLC 




NO CARRY EXISTS IF UE ENTER AT THIS POINT. 


024B 


B7 


14 




0K3A 


STA 


PTR1 


-- 


0240 


97 








TAX 




-- 










**** 






-- LOOX UP THE LEAST SIGNIFICANT DIGIT. 


024E 


06 


03 


28 




LDA 


TABLE, X 




0251 


B7 


19 






STA 


THOUTH 




0253 


24 


24 




**** 


BCC 


DONE 


AND CONTINUE ONLY IF THERE WAS A CARRY. 


















0255 


B6 


13 






LDA 


PTR2 




0257 


A9 


00 






ADC 


#0 


ADO THE CARRY. 


0259 


A1 


63 






CMP 


#99 


PTR2 > 99 7 


025B 


23 


05 






BLS 


0X4 


NO, WE'RE OX HERE. LOOX UP THE NEXT TWO DIGITS. 


0250 


AO 


64 






sue 


#100 


YES. ..MODIFY THE CTPTR, 


025 F 


99 








SEC 




SET THE CARRY, 


0260 


20 


01 




**** 


BRA 


OtC4A 


AND USE TABLE LOOX UP. 


0262 


98 






0K4 


CLC 




NO CARRY EXISTS IF WE ENTER AT THIS POINT, 


0263 


B7 


13 




0K4A 


STA 


PTR2 


-- 


0265 


97 








TAX 




-- 










**** 






LOOX UP THE NEXT TWO DIGITS IN THE TABLE 


0266 


06 


03 


28 




LOA 


TABLE, X 


-- 


0269 


B7 


18 






STA 


HUNDTH 




026B 


24 


OC 




**** 


BCC 


DONE 


AND CONTINUE ONLY IF THERE WAS A CARRY. 










***♦ 








0260 


B6 


12 






LDA 


PTR3 




026F 


A9 


00 






ADC 


#0 


ADD THE CARRY. 


0271 


B7 


12 






STA 


PTR3 


-- 


0273 


97 








TAX 




















-- LOOX UP THE NEXT TWO DIGITS IN THE TABLE. 


0274 


06 


03 


28 




LDA 


TABLE, X 


-- 


0277 


B7 


17 






STA 


ONEDEG 


• • 


0279 


81 






DONE 


RTS 














*** 
































************************************************************************ 












* SUBROUTINE TO DECREMENT THE BCO COUNTER (BCDCT). ************ 










*** 








027A 


B6 


16 




SUBBCO 


LDA 


CTPTRI 




027C 


AO 


01 






SUB 


#1 


CTPTR > 99 ? 


027E 


24 


03 






BCC 


0X6 


NO, WE'RE OX HERE. LOOX UP THE FIRST TWO DIGITS. 


0280 


AB 


64 






ADD 


#100 


YES, MODIFY THE CTPTR, AND 


0282 


99 






*** 


SEC 




GENERATE A BORROW. 


0283 


B7 


16 




0K6 


STA 


CTPTRI 


-- 


0285 


97 








TAX 




-- 










*** 






-- LOOX UP THE TWO LEAST SIGNIFICANT DIGITS. 


0286 


06 


03 


28 




LDA 


TABLE, X 


-- 


0289 


B7 


IB 






STA 


TENONE 


-- 


028B 


24 


OC 




*** 


BCC 


COMPLT 


AND CONTINUE ONLY IF THERE WAS A BORROW. 










*** 








0280 


B6 


15 






LDA 


CTPTR2 




028 F 


A2 


00 






SBC 


#0 


SUBTRACT THE CARRY. CTPTR > 99 ? 


0291 


B7 


15 






STA 


CTPTR2 


-- 


0293 


97 








TAX 




-- 










*** 






-- LOOX UP THE NEXT TWO DIGITS IN THE TABLE 


0294 


06 


03 


28 




LDA 


TABLE, X 


-- 


0297 


B7 


1A 






STA 


HUNDRD 


-- 



*** 



116 



788 


0299 


81 






COMPLT 


RTS 






789 


















790 










*************************«^******************«*************************** 


791 










******* 


SUBROUTINE TO DECREMENT THE POSITION COUNTER (DEGRES). •*•*•** 


792 










*** 








793 










**** FIRST CHECK TO SEE IF THE BINARY COUNTER HAS REACHED A MODULO 32 


79A 










**** 


NUMBER 






795 










**** 








796 


029A 


00 


20 


04 


OECPOS 


BRCLR 


M00_32,i 


STAT.DEC7 'MOO_32,STAT' SET ? 


797 










**** 








798 


0290 


A6 08 






LDA 


«8 


YES... 


799 


029F 


20 


02 






BRA 


DEC 


DECREMENT THE POSITION BY 0.008 DEGREES. 


800 










**** 








801 


02A1 


A6 


07 




0EC7 


LDA 


#7 


NO 


802 


02A3 


B7 


10 




DEC 


STA 


POSINC 


DECREMENT THE POSITION BY 0.007 DEGREES. 


803 










**** 








804 










ROUTINE TO DECREMENT THE POSITION COUNTER , 'DEGREES' , BY A 


805 










**** 


PREDETERMINED AMOUNT, 'POSINC'. 


806 










**** 








807 


02A5 


B6 


14 






LDA 


PTR1 




808 


02A7 


BO 


ID 






SUB 


POSINC 


PTR1 < 0 ? 


809 


02A9 


24 


03 






BCC 


0X8 


NO, WE'RE OX HERE. LOOX UP THE FIRST DIGIT. 


810 


02AB 


AB 


OA 






ADO 


#10 


YES, MODIFY THE CTPTR, AND 


811 


02AD 


99 








SEC 




GENERATE A BORROW. 


812 










**** 








813 


02AE 


B7 


14 




0K8 


STA 


PTR1 


-- 


814 


02B0 


97 








TAX 




-- 


815 










**** 






-- LOOX UP THE LEAST SIGNIFICANT DIGIT. 


816 


02B1 


06 


03 


28 




LDA 


TABLE, X 




817 


02B4 


B7 


19 






STA 


THOUTH 




818 


02B6 


24 


IF 






BCC 


DUNSUB 


AND CONTINUE ONLY IF THERE WAS A BORROW. 


819 










*** 








820 










*** 








821 


02B8 


B6 


13 






LDA 


PTR2 




822 


02BA 


A2 00 






SBC 


#0 


SUBTRACT THE BORROW. PTR2 < 0 ? 


823 


02BC 


24 


03 






BCC 


0X9 


NO, WE'RE OX HERE. LOOX UP THE NEXT TWO DIGITS. 


824 


02BE 


AB 


64 






ADD 


#100 


YES, MODIFY THE CTPTR, AND 


825 


02C0 


99 








SEC 




GENERATE A BORROW. 


826 










*** 








827 


02C1 


B7 


13 




0K9 


STA 


PTR2 


-- 


828 


02C3 


97 








TAX 




-- 


829 










*** 






-- LOOX UP THE NEXT TWO DIGITS IN THE TABLE. 


830 


02C4 


06 03 28 




LDA 


TABLE, X 


-- 


831 


02C7 


B7 


18 






STA 


HUNDTH 


-- 


832 


02C9 


24 


OC 






BCC 


DUNSUB 


AND CONTINUE ONLY IF THERE WAS A CARRY. 


833 










*** 








834 










*** 








835 


02CB 


B6 


12 






LDA 


PTR3 




836 


02CD 


A2 


00 






SBC 


#0 


SUBTRACT THE BORROW. 


837 


02CF 


B7 


12 






STA 


PTR3 


-- 


838 


02D1 


97 








TAX 




-- 


839 










**** 






-- LOOX UP THE NEXT TWO DIGITS IN THE TABLE 


840 


0202 


06 


03 


28 




LDA 


TABLE, X 




841 


0205 


B7 


17 






STA 


ONEDEG 


-- 


842 










**** 








843 


0207 


81 






OUNSUB 


RTS 






844 










*** 








845 










** 








846 










** 








847 










************************************************************************ 


848 










** 








849 










•* OUTPUT COUNT 


(OUTCT) 


. SUBROUTINE TO MOVE THE CURRENT COUNT (BCDCT) 


850 










** 


TO THE 


OUTPUT 1 


PORTS. REMOVES THE DECIMAL POINT FROM THE 


851 










** 


DISPLAY AND BLANKS ALL BUT THE LEAST SIGNIFICANT DIGIT. ALSO 


852 










** 


SETS THE MINUS 


SIGN IF APPROPRIATE. 


853 










** 
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854 




0208 


OUTCT 


EQU 


$ 




855 






** 








856 


02D8 


B6 IB 




LOA 


TENONE 




857 


02DA 


B7 02 




STA 


PORTC 




858 






** 








859 


02DC 


B6 1A 




LOA 


HUNORO 




860 


02DE 


B7 00 




STA 


PORTA 




861 














862 


02E0 


IE 01 




BSET 


DECPT,PORTB 




863 


02E2 


19 01 




BCLR 


BLANK, PORTB 




864 














865 


02E4 


81 




RTS 






866 














867 














868 














869 






OUTPUT POSITION (OUTPOS). 


SUBROUTINE TO MOVE THE CURRENT POSITION 


870 






** 


COUNT 


(BCOCT) TO THE 


OUTPUT PORTS. THE DECIMAL POINT IS 


871 






** 


OISPLAYEO , AND ONLY 


THE MOST SIGNIFICANT DIGIT IS BLANKED. 


872 






** 








873 




02E5 


OUTPOS 


EQU 


$ 




874 














875 


02E5 


B6 19 




LOA 


THOUTH •• 




876 


02E7 


A1 05 




CHP 


#5 




877 


02E9 


25 20 




BLO 


TRUNC 


IF 5 > 'THOUTH' SIMPLY TRUNCATE THE 


878 


02EB 


B6 18 




LOA 


HUNOTH 


•• DISPLAY. OTHERWISE... 


879 


02ED 


A4 09 




ANO 


#9 


-- IF THE LAST DIGIT ISN'T A NINE IT IS 


880 


02EF 


A1 09 




CMP 


#9 


-- EASY TO ROUND UP. JUST ADD A ONE. 


881 


02F1 


26 10 




BNE 


OECIMAL 


-- 


882 


02F3 


B6 18 




LOA 


HUNOTH 


-- BUT IF THE LAST DIGIT IS A NINE CHECK TO 


883 


02F5 


A1 99 




CMP 


#$99 


-- SEE IF IT'S 99. IF SO IT GETS GRIM. 


884 


02F7 


27 04 




BEO 


UGLY 




885 


02F9 


AB 07 




AOD 


#7 


-- IF THE NUMBER IS X9 AND X .NE. 9, THEN 


886 


02FB 


20 10 




BRA 


PCOUT 


-- JUST ADD SEVEN TO ROUND UP. DUE TO 


887 












-- HEXIDECIMAL. 


888 












** IF THE LOW TWO DIGITS ARE BOTH NINES 


889 


02 FD 


A6 00 


UGLY 


LOA 


#00 


* AND UE NEED TO ROUND UP 


890 


02FF 


B7 02 




STA 


PORTC 


MAKE THE LOW TWO DIGITS BOTH ZEROS 


891 


0301 


99 




SEC 




AND SET THE CARRY. 


892 














893 


0302 


B6 17 




LOA 


ONEDEG -- 


CHECK THE LAST DIGIT AS BEFORE. 


894 


0304 


A4 09 




ANO 


#9 


IF USING THIS PORTION OF THE CODE 


895 


0306 


A1 09 




CMP 


#9 


THERE HAD TO BE A CARRY. 


896 


0308 


26 13 




BNE 


NEXT 


-- IF THE LAST DIGIT IS A NINE DO THE 


897 


030A 


B6 17 




LOA 


ONEOEG 


-- CARRY HERE. IF NOT USE THE ADC 


898 


030C 


AB 07 




ADO 


#7 


INSTRUCTION TO TAKE CARE OF IT 


899 


030E 


20 11 




BRA 


PAOUT 


BELOW. 


900 


0310 


B6 18 


OECIHAL 


LOA 


HUNOTH •• 




901 


0312 


AB 01 




ADO 


#1 




902 






** 






-- THIS IS ALL THAT NEEDS TO BE DONE IF 


903 


0314 


B7 02 




STA 


PORTC 


THE LAST DIGIT IS NOT A NINE. 


904 


0316 


20 05 




BRA 


NEXT 




905 






irk 








906 


0318 


B6 18 


TRUNC 


LOA 


HUNOTH -- 




907 


031A 


B7 02 


PCOUT 


STA 


PORTC 


AND IF THERE IS NO CARRY IT'S EVEN EASIER. 


908 


031C 


98 




CLC 


-- 




909 






** 








910 


031D 


B6 17 


NEXT 


LOA 


ONEOEG 




911 


031 F 


A9 00 




AOC 


#0 




912 


0321 


B7 00 


PAOUT 


STA 


PORTA 




913 






** 








914 


0323 


18 01 




BSET 


BLANK, PORTB 




915 


0325 


IF 01 




BCLR 


OECPT,PORTB 




916 






** 








917 


0327 


81 




RTS 






918 






** 








919 






*********************************************************************** 
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920 

921 

922 

923 

924 

925 

926 

927 

928 

929 

930 

931 

932 

933 

934 

935 

936 

937 

938 

939 

940 

941 

942 

943 

944 

945 

946 

947 

948 

949 

950 

951 

952 

953 

954 

955 

956 

957 

958 

959 

960 

961 

962 

963 

964 

965 

966 

967 

968 

969 

970 

971 

972 

973 



0328 

0320 

0332 

0337 

033C 

0341 

0346 

034B 

0350 

0355 

035A 

035F 

0364 

0369 
036E 
0373 
0378 

0370 
0382 
0387 



038C 



0F38 

0F38 



0FF8 

0FF8 

OFFA 

OFFC 

OFFE 



1000 



Li 



00 


01 


02 


03 


04 


05 


06 


07 


08 


09 


10 


11 


12 


13 


14 


15 


16 


17 


18 


19 


20 


21 


22 


23 


24 


25 


26 


27 


28 


29 


30 


31 


32 


33 


34 


35 


36 


37 


38 


39 


40 


41 


42 


43 


44 


45 


46 


47 


48 


49 


50 


51 


52 


53 


54 


55 


56 


57 


58 


59 


60 


61 


62 


63 


64 


65 


66 


67 


68 


69 


70 


71 


72 


73 


74 


75 


76 


77 


78 


79 


80 


81 


82 


83 


84 


85 


86 


87 


88 


89 


90 


91 


92 


93 


94 


95 


96 


97 


98 


99 



** SET UP THE TABLE TO BE USED WITH BCD INCREMENT/DECREMENT ROUTINES. 

♦ ENDS 

* DATA 
TABLE FCB 



$00,$01,$02,S03,i04,S05,i06,$07,i08,$09 
S10,S11,$12,$13,S14,$15,$16,$17,S18,S19 
S20,$21 ,S22,S23,$24,S25,$26,S27,$28,S29 
S30,$31,$32,S33,S34,$35,S36,S37,S38,S39 
S40,S41 ,$42,$43,$44,i45,$46,S47,$48,$49 
$50,S51,S52,S53,S54,$55,S56,S57,S58,S59 
$60,S61,$62,$63,$64,$65,$66,S67,$68,S69 
S70,S71 ,S72,$73,S74,S75,S76,S77,S78,$79 
180 , S8 1 , $82 , $83 , $84 , $85 , $86 , S8 7 , S88 , $89 
$90 , $9 1 , $92 , $93 , $94 , $95 , $96 , $97 , $98 , $99 



FCB 
FCB 
FCB 
FCB 
FCB 
FCB 
FCB 
FCB 
FCB 

* ENDS 

* CODE 

************************************************************************ 

** 

** 

** 



ABSOLUTE 



** 

** 



SET UP MASK OPTION REGISTER. 

JUST TO ENSURE THAT THE INTERRUPT VECTORS 
ARE CORECTLY LOCATED. 



07 





ORG 




MOR 






FCB 




#8IT2*B1T1+BIT0 














** 


COMMENTS: 




** 


BIT 


7 


CLOCK SOURCE 0 = 


CRYSTAL . 


** 


BIT 


6 


TIMER OPTION 0 = 


INTERNAL. 




BIT 


5 


TIMER/CLOCK SOURCE 


0 = INTERNAL 


** 


BIT 


4 


NOT USED. 




** 


BIT 


3 


NOT USED. 




** 


BIT 


2 


SET - 




** 


BIT 


1 


SET - PRESCALE 


SELECT 111 =: 


** 


BIT 


0 


SET - 





** 

** 

** 



nes Assembled : 973 



> 128 



** 

** 

************************************************************************ 

** 

** 



ASSIGN INTERRUPT VECTORS. 





** 


ORG 


INTRPT 




0139 




FDB 


BLINK 


TIMER/INT2 INTERRUPT VECTOR 


0158 




FDB 


COUNT 


EXTERNAL INTERRUPT VECTOR. 


0158 




FDB 


COUNT 


SOFTWARE INTERRUPT VECTOR, 1 


0080 




FDB 


RESTRT 


RESET VECTOR. 



ENDS 

END 



Assembly Errors : 0 
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